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The three legged walker is proposed as a mobile work platform for numerous tasks 
associated with Lunar Base site preparation and construction. It is seen as one of several forms 
of surface transportation, each of which will be best suited for its respective tasks. 

Utilizing the principle of dynamic stability and taking advantage of the Moon’s Gravity, it 
appears to be capable of walking in any radial direction and rotating about a point. Typical 
curved path walking could involve some combination of the radial and rotational movements. 

Comprised mainly of a body, six actuators, and six moving parts, it is mechanically quite 
simple. Each leg connects to the body at a hip joint and has a femur, a knee joint, and a tibia 
that terminates at a foot. 

Also capable of enabling or enhancing the dexterity of a series of implements, the walker 
concept provides a mechanically simple and weight efficient means of drilling, digging, mining, 
and transporting cargo, and performing other like tasks. 


A proof of principle machine has demonstrated the feasibility of the walking concept. 
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Introduction 


The Georgia Institute or Technology has been involved in the design of machinery for the 
construction of the Lunar Base for several years. Because of the unique and stringent 
constraints imposed upon any piece of machinery that will operate in the Lunar environment, a 
three-legged walking robot, called SKITTER, is being designed and developed. While 
SKITTER has been initially designed for Lunar applications, it is not solely limited to the 
moon. Some terrestrial applications include hazardous environments, military reconnaissance, 
underwater operations, etc. The purpose of this paper is to discuss and detail some of the 
initial work leading to the development of the theory of a three-legged walker (gaits, modes of 
operation, kinematics, and dynamics) and the proof of principle model. 

The task of designing automated machinery for the Lunar environment is very difficult 
Besides the intense temperatures and lack of an atmosphere, the one-sixth gravity complicates 
the task of moving machinery and cargo. The reduced gravity, while making any payload 
lighter, also reduces the normal force at the ground to such a low point that it becomes 
extremely difficult to be able to do even the basic task of scraping soil at a construction site. 
Even though the weight has been reduced by one-sixth, the inertia has not been similarly 
reduced. Thus, it is not a sufficient solution to the problem to add more mass to the vehicle to 
generate the required normal force because the power requirements for acceleration and 
deceleration would then rise sharply. Since any construction machine must be able to traverse 
all terrain that it might encounter, the decision to use legged locomotion over wheeled vehicles 
was justified. 

SKITTER is a very simple device from a mechanical point of view. It consists of only six 
actuators, six moving parts, and a central body (figs. 1 and 2). The legs are located radially 
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through the centerline of the body at 120 degrees apart from the other. The upper part of the 
leg. or femur, connects to the body at a hip joint. Connected at the other end of the femur is 
the lower leg, or tibia, which terminates as a foot at its end. To move the legs, two actuators 
per leg are used. The first actuator rotates the femur about the hinge line formed by the union 
of the femur and the central body, while the second actuator rotates the tibia about the hinge 
line created by the union of the femur and tibia. In this way, each leg operates in its own 
plane. The central body serves a connect point for various implements that may be attached to 
the walker and as host for the electronic hardware and power supply. 

This mechanical simplicity does, however, have its disadvantage in the fact that more 
complex controls are needed for machine stability. For stability in motion, the main difference 
between a three-legged walker and the other walking devices like the Odetics and Ohio State 
walking machines is that the Georgia Tech walker depends on dynamic stability to maintain its 
motion. It must, and does, operate routinely with less than three legs having contact with the 
ground at any particular moment. As the device pushes off from the ground with its legs, the 
center of mass undergoes a horizontal and vertical motion. This differs from the previously 
mentioned walkers dramatically in that they strive to constantly maintain a level motion of the 
center of mass. While it does take energy to move the center of mass vertically, that energy is 
recovered when the body and leg are brought back into contact with the ground with no energy 
expenditure. Since the walker is not statically stable at all times in this motion, the controls 
complexity increases dramatically. This situation is similar to the unipod and bipods being 
developed at Carnegie Mellon and Gemson Universities, however with two major distinctions. 
The first is that while the tripod is not statically stable at all times while in motion, the device 
can always return to a statically stable position by simply allowing the leg or legs to return to 
the ground provided that the center of mass of the device is still located inside of the triangle 
formed by the foot projections on the ground. The second major difference is related to the 
first one in that only very small movements of the legs are needed to generate motion of the 
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platform. By taking small steps, the danger of tipping and energy consumption is minimized. 

This motion of pushing off from the ground so that the foot actually leaves the ground is 
also significant from another point of view. That it is possible to establish a rocking motion of 
the walker such that the inertia and momentum from the restoration of the leg back to the 
ground, aids in the pushing off from the ground of the other legs. As will be discussed later in 
this paper, this type of motion is very similar to that of a man on crutches. 

Motion 

Mechanical simplicity is a primary design constraint for SKITTER. Although other 
walkers incorporate many complex linkages and bearings in their design, SKITTER utilizes only 
six actuators ( two per leg ) and six hinges ( two per leg ) to generate motion (fig. I and 2). 

The femur actuator changes the angular position of the femur relative to the central body, and 
the tibia actuator changes the angular position of the tibia relative to the femur. By 
coordinating the position and velocities of the actuators, a variety of platform positions and 
motions is achieved. 

Lean 


SKITTER'S basic mode of operation is to reorient its central body or "lean" by 
reconfiguring the legs while always maintaining three fixed points of contact with the surface. 
To understand the lean sequence as well as the other modes of operation described later in this 
section, a fixed axis (X-Y-Z) is established such that the walking surface lies in the X-Z plane 
and the positive Y axis is normal to the surface following the right hand rule. SKITTER is 
oriented such that the motions of leg A are confined to the X-Y plane and the feet of leg B 
and leg C construct a line parallel to the Z axis known as pivot line A. A second axis (x-y-z) 



may b« established such that the x-z plane lies in the mid-plane of the central body with the 
positive x axis in the direction of leg A and the positive z axis parallel to and in the same 
direction as the Z axis. The positive y axis is normal to the mid plane and follow* the right 
hand rule. Finally, a third axis (x'-y •*') may also be established on the femur at the femur A 
- tibia A hinge line such that the positive z' axis is parallel and in the same direction as the 
positive Z axis (fig 3). 

One possible example of the lean mode sequence is shown in fig 4. Starting with SKITTER 
at a static equilibrium position known as the 90-90 configuration ( the femur-tibia and tibia- 
surface angles are both 90 degrees ), femur A slowly rotates cw about the z axis and tibia A 
slowly rotates ccw about the z' axis such that foot A never leaves its initial contact point with 
the surface. The motion of femur A and tibia A is analogus to the motion of a crank and 
coupler of a slider crank mechanism discussed in detail in the kinematics section of this paper. 
The movements of leg A cause the central body and other two legs of SKITTER to rotate about 
pivot line A. As femur A and tibia A reach a new desired position, the central body has 
rotated and translated from its initial position with respect to the X-Y-Z reference frame. 

One interesting motion of the central body is its ability to translate along its local y axis at 
an obtainable platform configuration. This can be accomplished by actuating each leg such that 
all three body-femur joints have a velocity vector parallel to the y axis and of equal magnitude. 
Therefore, as a drill rig platform, SKITTER eliminates the need for angular positioning and 
vertical feed mechanisms by leaning to the correct orientation and then raising and lowering 
itself along the drill string path by a series of coordinated actuator movements. The operation 
is completed with SKITTER’S feet never losing contact with the ground. Also, the platform is 
able to achieve a position such that the mid-plane of the central body is parallel to the plane of 
its feet by simply making the body-femur angle and the femur-tibia angle of all three legs 
equal respectively. The work volume which encloses all of the possible orientations of the 
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eentral body is limited to the range of the actuators and the physical characteristics of the body 
and leg components. 


Leap 


One method lor maneuvering around obstacles which might impair the movement of 
SKITTER such as small rocks or ditches is to "leap" over them. SKITTER simply reorients its 
central body such that the y axis lies in the intended direction of travel. All three legs move 
such that the body-femur joints of all three legs have a velocity vector of equal magnitude and 
parallel to the y axis and supply a sufficient downward force to make SKITTER leap. With 
increases in control logic and proper frame design, the magnitude of the leap increases giving 
SKITTER the ability to achieve larger distances, and thus imitating the 'skip walk’ used by the 
astronauts on the lunar missions. One advantage of the leap mode is that the magnitude of 
directions in which SKITTER could translate is limited only by the possible orientations of the 
central body; therefore, with proper design, true omni-directional motion can be obtained. 


Crutch Walk 


SKITTER’S crutch walk mode for translational motion differs dramatically from most 
current walker designs which usually move one or more appendages while keeping at least three 
points of surface contact at all times. SKITTER, on the other hand, tries to capitalize off of 
its inertial characteristics and dynamic stability to propel itself forward. One inherent fact of a 
three legged platform such as SKITTER is that it will always be statically stable as long as all 
three feet are in contact with the surface and its center of gravity is positioned over the 
triangle formed by the feet. However, if one of the legs loses contact with the surface, the 
platform becomes statically unstable and starts rotating due to gravity about the pivot line 
constructed by the feet of the other two legs. By combining this fact with the lean motion. 
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SK1TTER ran be made to translate over a surface similar to a person walking with crutches. 

For example, starting at the 90-90 equilibrium position, the femur and tibia of leg A begin 
the slider crank motion described in the kinematics section of this paper (fig 5). The central 
body starts to rotate about pivot line A as in the lean mode; however, this time, femur A and 
tibia A hav- acquired enough angular acceleration to supply a sufficient force at the foot and 
consequently a sufficient torque about pivot line A to cause foot A to lose contact with the 
surface (i.e. foot A pushes off from the surface fig 6). The entire platform continues to rotate 
about pivot line A until SKITTER'S potential energy equals the kinetic energy imparted by leg 
A as it left tV surface. At this point, the entire platform rotates about pivot line A in the 
opposite direction due to gravity. While leg A is away from the surface, femur A and tibia A 
rotate into a new configuration causing foot A to swing towards the central body (fig 6). As 
leg A comes back into contact with the surface, the central body is in a new orientation and 
foot A has translated to a new location on the surface In relation to the X-Y-Z reference frame 
(fig 7). 

The next stage has leg B and leg C moving identically in their respective planes of 
motion, legs B A. C reconfigure as shown in figure 7 causing a rotation of the central body in 
the X-Y plane about foot A. During their reconfiguration, legs B ft C acquire adequate 
angular acceleration to supply a sufficient force at foot B and foot C, and consequently 
adequate torque about foot A, to cause the feet to lose contact with the surface (fig S). Again, 
the platform will continue to route in the X-Y plane about foot A until its potential energy 
equals the kinetic energy imparted by legs B A C as they left the surface. At that time, the 
platform begins to route in the opposite direction due to gravity. While away from the surface 
all three legs reconfigure to there original 90-90 surting configuration (fig S). As foot B and 
foot C reestablish contact with the surface, it is seen that the feet are in a new location and 
that the center of gravity has translated (fig 9). It is important to point out that if the roles of 


7 


leg A and legs B & C are interchanged (Reversed Crutch Walk mode) then a translation in the 
opposite direction occurs giving six radial directions of translation without a required rotation 
of the platform. 

Surprisingly, it has been found by analysis that it takes little energy to have a leg push off 
from the surface with adequate force to give the leg time to reconfigure into a new position. 
Similarly, only a small rotation of the platform about the pivot line is needed to give adequate 
space for reconfiguration of the leg; therefore, the chances of the platform tipping over are 
small. 

One important benefit which arises out of the Crutch Walk motion Is a decrease in the 
energy input to the system as the platform gains momentum while it walks. With an increase in 
the gait of the crutch walk sequence and the proper control strategy. SKITTER is able to 
achieve a stable rocking motion. Just as a person who is walking quickly on crutches uses his 
momentum to swing himself forward, SKITTER uses its momentum to propel itself forward. 
Therefore, the horsepower to maintain the rocking motion is small since the energy input to the 
system only has to account for the losses in the system due to SKITTER contacting the 
surface. 

Slopes can be negotiated quite easily using either the Crutch Walk or Reverse Crutch Walk 
mode with the requirement that the force vector due to gravity acting through the eg of 
SKITTER always intersect the triangle formed by the three feet. This requirement insures that 
SK ITTE R will not over turn and can always revert to a statically stable position. The grade of 
slope that SKITTER can effectively negotiate is primarily determined by the femur and tibia 
dimensions which determine the size of the triangle. A larger foot print triangle results in a 
larger margin of safety from over turning and therefore a larger grade of slope can be 
negotiated. The platform is able to walk up, down or tact a slope by assuming an optimum 
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nominal position (i.e. taking the largest step possible without overturning) and proceeding with 
one of the sequences described above. 


Squat 

SKITTER has the ability to lower its central body by having each teg repeat the sequence 
of pushing off of the surface, reconfiguring so that the foot swings away from the central body 
and landing on the surface to reestablish static equilibrium. If the sequence is carried through 
enough iterations, the central body of SKITTER would come to rest on the surface with the 
legs extended outward (fig. 10). This particular position is extremely advantages if the 
platform is being used in conjunction with a lifting device such as a crane. In the squat mode, 
the legs form outriggers to counter the weight of the cargo being lifted and eliminate the need 
for counter weights or other stability mechanisms. 

Pivoting 

Although the platform has six radial directions for translation, there will be situations that 
will require for the platform to rotate about the surface Y axis. SKITTER is capable of two 
different pivoting modes. The foot pivoting mode allows the platform to pivot around one foot 
while the complex pivot mode allows SKITTER to swing one foot through an arc in the surface 

X-Z plane . 

In the foot pivoting mode. Skitter pushes leg A off the surface, and while in the air, leg B 
reconfigures resulting in a torque about foot C . The platform will pivot around foot C, and as 
leg A contacts the surface, SKITTER will once again be statically stable. Since the hinge lines 
of the platform dictate a 120 degree interval between the planes of motion of the legs, the foot 
pivoting mode would also require that foot B either slide in a arc about foot C or be away 
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from the surface for the rotation to occur. 

In the complex pivoting mode, SKITTER pushes leg A off the surface, end white in the 
air, leg B increases its body-femur angle while leg C decreases its body-fomu angle. Thn 
reconfiguring of the legs in this manner will cause the platform to under go rotations around 
the surface Y & X axis causing leg A to swing in a arc in the surface X-Z plane while both 
leg A and leg B remain fixed to the ground. Once leg A contacts the ground again, the 
platform becomes statically stable. If the motion is carried through for all three legs, 
SKITTER achieves a net rotation about its eg. Unlike the foot pivoting mode, the complex 
mode does not require foot B to slide or leave the surface for the rotation to occur. 

Self Righting Mode 

If, for some reason, the platform tripped or fell during one of the modes of operation, it 
has the capability of righting itself since the legs have a range of motion extending above slJ 
below the mid-plane of the central body (fig II). As an extreme example, if SKITTER 
tripped and landed completely upside down on the surface, the platform could tuck two legs in 
toward the central body while the third leg pushed down on the ground to flip the platform 
over to the correct orientation (fig. 12). The resulting motion would simulate a person 
summersaulting and landing on his feet. This unique fault tolerant capability of SKITTER 
makes the platform a valuable remote field robot. 

The movements just discussed were achieved bv utilizing the inertia charatcistics of 
SKITTER in conjunction with the coordinated actions of the six linear actuators. A direct 
relation between movement complexity and control complexity is apparent; however, the 
movements discussed be realized by current control strategies and devices. 



Of the many possible combinations of motions of the femur and tibia joints, only two 
possible combinations of motions exist such that the feet do not slid on the ground. The first 
motion is a linear movement of the center of mass as in the jump mode of operation. To 
accomplish this, the femur and tibia joints must combine their motions to produce a linear 
motion at the each of the hinge lines of the femur and the body. To model this linear motion 
of the center of mass, each leg is modeled as an offset slider crank mechanism. If is it desired 
for the walker to actually leave the ground, then the device must supply enough force tnat the 
walker has sufficient velocity at the end of the leg movements to leave the ground, or jump. 
The derivation of this model is developed here and the results of that model presented later. 

The second method of motion for the walker is one that produces a rotational displacement 
of the center of mass relative to a pivot line, or the lean motion. This lean motion is also the 
fundamental motion for the crutch walk discussed earlier. The only difference between the 
motion; of the femur and tibia joints in the lean configuration and the crutch walk is that at 
the end of the crutch walk motion, the body has enough angular velocity to allow the foot to 
leave the ground and this allows the leg to reconfigure while off the ground. To model this 
rotational motion of the body, a four-bar linkage is constructed where the four links are the 
ground, the tibia, the femur, and a link that is composed of the rigid structure of the body and 
the other two legs. The final link is connected to the hinge of the femur and body of the leg 
that is moving and terminates at the pivot line formed by the two feet that do not move. 
Derivation of the kinematic and dynamic model is discussed in this section and the results of 
the computer simulation is diseased in a latter section. 

JUMP MODE 



The first motion to be discussed is the jump motion. This motion ctn be divided into to 
distinct phases. The first phase is the acceleration of the body in the local vertical axis to a 
prescribed velocity such that during phase two, the jump phase, the body is off the ground and 
it begins to decelerate under the force of gravity. Since linear motion is required, an offset 
slider crank mechanism is used to simulate the motion of the legs (Fig. 13a). As a 
simplification of the mathematical model, the problem was inverted such that the body of 
SKITTER was considered to be ground and the foot was constrained .j move in the linear 
fashion. Thus, the femur is considered to be the crank and the foot is the slider. A derivation 
of that model is presented here along with a measure of the forces, torques, and angular 
velocities needed to produce this motion. 

To conduct this analysis, several parameters must be defined by the user of the program 
developed to model this motion. The first parameter is the vertical distance, H, desired for 
SK ITTE R to jump (Fig. 13c). The second parameter is the vertical distance, D, that the legs 
are allowed to displace to accelerate the body to the desired velocity (Fig. 13b). This velocity, 
V q, is obtained using the conservation of potential and kinetic energy theory where the final 
height is the jump distance ,H, and the initial velocity is V . This results in, 

V Q - (2gH) 1/2 

In this equation, g represents the gravitational constant. For simplicity, constant linear 
acceleration, A Q , is maintained at the center of mass for the acceleration phase. Thus, the 
acceleration necessary to accelerate the body to the desired velocity, V Qf over the linear 
distance, D, is. 


A 0 * VJ/2D 
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Given the initial joint angles of the leg (the angle between the local x axis and the femur 
centerline, Ij.and the angle between the femur and tibia centerlines, toe other critical 
angle for the dynamic and kinematic analysis is the angle between the tibia and the vertical 
axis, l (Fig. 13a). This angle is determined from the joint angles to be, 


# 2 - #, - »/2 - * 

The next step is to derive the angular velocities for the femur and tibia links. The angular 
velocity equations are written using the standard equations for finding the velocity of a link. 
The equations are written from both ends of the link (i.e. one equation relates the velocity of 
point B to the ground, A, and the other relates the velocity of point B to the foot, point C, 
where the velocity at point C is a known parameter). The two equations are. 


Yb " Ye + -ab x -ab 


Yb-Yc + Sbc x ?cb 


When the above equations are evaluated for this particular geometry, the following equation is 
derived. 


(-w ab Lsin(tfj)) i_ - (-w gb Lcos(# )) j, - (-w^LcosM) i. - (Vq + w^LsinM) l 


By comparing the i_ and £ terms of the above equations, then the magnitude of the angular 
velocities can be derived. 


I 


w ab " VqCOsM/Ucos^i^)) 
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"bc - w^sintljJ/cosW 

Like the velocity equations presented earlier, acceleration equations can be written in a 
similar manner. 

*b " *a + 2, b * 5.b + S?ab x <2ab x Sab> 

*b " *c + 2bc x Bcb ♦ 2bc x ( 2bc x B cb > 

Evaluating the above equations for the geometry of this problem yields, 

(-a ab Lsin(»,) - w^liosd,)) i, ♦ (-a^Lcosf#,) ♦ wJ b Lsin(#,)) L - 
(-a^LcosW ♦ wj Lsin(^)) i. + (-A Q - o^Lsinf#) - w^Lcostf)) i 
Solving the above equations properly for the magnitude of the angular accelerations gives, 
°bc " - A 0 Lsin (^ 1 )- w bcL 2 cos(^)sin(« 1 )-w^ c L 2 sin(^)cos(# 1 )-w ab L 2 / -L^cos^+Jj)) 

“ab " ( a bc Lco ^^ ) " a bc Lsin (*) ' w ^b Lcos<, l )) 1 

For a complete force and torque analysis of the leg motion, it is necessary to obtain the 
linear acceleration of the center of mass for the tibia, and Y C g. Using the acceleration 
equation for the center of mass relative to the foot gives. 


* C g “ *c + 2tc x *ccg ♦ 2bc x ( 2bc x *ccg> 


Evaluating this equation for the geometry yields, 


-eg" (- a bc Lco,( * )/2 + - * <- A 0 ' ®bc L * in W/ 2 ' «^.Lco*(^)/2) j. 

Which leads to, 

X cg - -o^Lco stf)/2 ♦ wJgLsinW/2 
Y cg - -A q - o^UinW/2 - «J c Lcos(#)/2 

Su mmi ng the forces for the tibia (note that the force P is the reaction force from the 
ground due to the weight of SKITTER) enables a determination of the reaction forces at point 
B, 


EF x -mrXcg 


bx 


EFy - m ( Y C g ■ P - F^ - mjg 


Solving for the reaction forces. 


F bx " m t X cg 


F by " m t V “t 8 - P 


The summation of the moments about points A and B are. 


£M b - I, “be “ PLsi °W> " m t ® Lsin <^)/ 2 - T t 


EM g - I f o, b - F^Lco^#,) - F bx Uin(#j) - m f |Lco*(# 1 )/2 - T f 

Thus, the torque needed about the femur and tibia are, 

T t " ! t°bc " PL * 5n W * m t gL$in(d)/2 

T f - If« ab ♦ F bx Lsin(#j) ♦ m f gLcos(»j)/2 - F by Uos(# 1 ) 

The calculations for the mass moments of inertia are approximations based upon a rectangular 
cross section of the leg. The variable V is equal to the length of the leg and the variable *b* is 
equal to the width of the cross section of the leg. 

l x - m, eg (a 2 ♦ b 2 ) / 12 

From the above equations, all the variables are known except for the torques. Therefore, 
the torque needed at either the femur or tibia joints is known for any given position of the 
legs. 


These equations were then implemented in a computer program to evaluate the angular 
velocity, torque, and horse power requirements for each joint of the leg as it attempts to make 
the leg jump the desired distance. 

LEAN MOTION 

As stated earlier, the lean motion is the foundation of the crutch walk and provides 
dexterity to the platform. The kinematic model for this mode of operation is a four-bar 
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linkage where the four links are (Fig. 14a), 


• Tibia 

• Femur 

• Rigid structure consisting of 
everything but links one and two 

• Ground 

The lean motion can also be divided into two separate phases of motion. The first is the 
acceleration phase where the femur and tibia move in such a fashion as to impart to the center 
of mass a prescribed angular velocity. This angular velocity is sufficient to allow the foot to 
leave the ground after the forces have ceased to be applied to the joints. 

As in the jump mode analysis, it is necessary to input two parameters into the program to 
allow the remainder of the variables to be set For the lean mode, it is necessary for the user 
to define the acceleration angle, *, which is the angle that the center of mass of SKITTER is 
to undergo to obtain the necessary angular velocity (Fig. 14b). The other input parameter is 
the angular displacement, », that the user wants the center of mass to undergo after the foot 
leaves the ground (Fig. 14b). 

With these input parameters, an initial angular velocity must be calculated so that the 
center of mass will undergo the desired amount of rotation. This initial angular velocity, w Q , is 
calculated from the conservation of potential and kinetic energy theory where the final angular 
velocity is zero and the final height of the center of mass is H 2 , where H 2 is defined as (Fig. 
14b): 


H 2 - rsin(*+$) 
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Where r is defined as the constant perpendicular distance from the center of mass of SKITTER 
to the pivot line formed by the stationery feet Thus, the initial angular velocity must equal: 

w Q - (2mgH 2 / I) ,/2 

For this equation, the m terms refers to the mass of SKITTER and the I term is the moment of 
inertia for SKITTER about the pivot line. 

As with the jump motion, a constant angular acceleration, c*q, is assumed over the acceleration 
angle for the center of mass. This acceleration results in the desired angular velocity, Wq, at the 
end of the acceleration angle, V. 


Oo-« 0 2 /<2*> 

For this motion, there are a number of geometric parameters that must be summarized for 
the following analysis to be clear. First, the j >int angles for the different links are designated 
as follows (Fig. 14a): 


4j: angle between the tibia link and the ground 

9 ^. angle between the femur link and 
horizontal at the femur-tibia joint 


9 ^. angle between the rigid body of 


SKITTER and the ground. 
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AS in the jump motion, all of these angles are measured in the right hand sense. The letters 
designate the various joints in this analris. Point A is the hip joint, point B is the knee joint, 
point C represents the contact point between the ground and the tibia, and point D is the 
contact point for the line that is perpendicular to the pivot line and contains the center of mass. 

With this variable definition, the following equations can be written for the velocity of the 
points on the links: 


Y b " Y c 4 *bc x ?cb 
Ye " Y b 4 -ab* -bn 
Ya “ Yd 4 -ad x -da 

The above equations are evaluated using the following conditions, y c - y d - 0. With 
this above condition and the fact that w gd is the input velocity following a prescribed 
acceleration profile, then the remaining angular velocity terms can be calculated by solving the 
above equations for the scalar magnitudes of the angular velocities: 

w ab “ 

w bc " ( w ad Rsin ^ " w ab Lsin ^2^ Ls ' n ^P 

As with the velocity equations, similar equations for the angular acceleration can be 
written. 


A b “ A c ♦ Hbc x ?cb 4 S?bc x ( 2bc X Scb> 
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*a - *b ♦ 2.b x Bb. ♦ 2.b x <2.b x Bb«) 

A a - A d .♦ 2,d* Bda ♦ Sftd x (Sf«| x Bda> 

Again applying the boundary conditions of A c - A d - 0 and the fact that the angular 
acceleration, a jd> is the Oq calculated earlier, the following magnitudes for the angular 
accelerations may be derived. 

°ab “ ( Ra ad jin(# l "ty ” Rw ad C05<# l "V + ^b^W +Lw bP /Ltin(# l" V 
°bc " (“ad** 1 ®^ * w ad Rco,< ty " w bc Lco *< # i) - « ab Lain(# 2 ) - w^ l> Lcos(# 2 ))/Uin(l 1 ) 

Up to this point, the angular velocity and angular accelerations have been calculated for 
the various linlu. To complete the analysis for the forces and torques necessary to achieve the 
input motion, the linear acceleration of the center of mass for the fem.ur, tibia, and rigid body 
must be calculated. Since all the velocities and accelerations are already known, this is very 
simple. 


^.cg " A b,x /2 


X F,cg " A b* • ( a ab Uin(, 2> - -l b ^ 2 ))/2 
Y F,cg “ A bx + <“ ab Lcos < # 2 ) - « ab Ls»(* 2 ))/2 




X BODY,cg “ A a,x ^ 2 
Y BODY,cg " A a ,/ 2 

Now the free body diagrams can be written for this system. Unfortunately, the system b a 
coupled one, which means that the input torque, T. about the femur can not be easily solved 
for without solving for a eight other variables at the same time. These additional variables are 
the reaction forces at the joints and ground. Thus, the equations can be best solved by putting 
the equations into matrix form and then solving them using Gaussian elimination with pivoting. 
The form of the equations to be solved is as follows. 
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From the solution of this matrix for the variable T. the input torque required to have 
SK ITTE R lean and lift off from the ground can be calculated. 
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Dynamic Simulation 

of the Motion of 

SKITTER 

To simulate the motion of SKITTER, the dynamic and kinematic equations were 
developed for the basic motions, the Jump and the lean motion, and then Implemented In a 
computer program. These motions do not cover the broad scope of motions possible, 
especially all ’he possible motions resulting from the non-symmetrlc configurations of 
the legs. However, these two motions do represent the basic modes of operation for the 
machine (the other gaits are a combination of these two motions). Also Included In this 
analysis Is an actuator sizing routines which allows the user to determine If a given 
actuator (rotary or linear) can supply the necessary torque and speed. 

The programs developed are written In a general format to allow the user to vary the 
physical parameters of SKITTER as weD as modify its performance parameters. These 
performance parameters include the distance that the waBter win Jump In the air, the 
distance that the legs accelerate through before they leave the ground, and the actuator 
specifications (torque and velocity limitations). The physical parameters that can be 
varied on the model include all of the actuator attach points, the length of the femur and 
tibia, the weight of the femur and tibia (and thus It's inertia), the weight of SKITTER, the 
gravity, and the type of actuator (rotary or linear). 

From the dynamic analysis of the motion of SKITTER, a maximum torque and angular 
velocity about the hip and knee joints of the walker are calculated. If the type of actuator 
is a rotary one, then these values are compared against the Input specifications for the 
actuator to determine if they will suffice. For a linear actuator, the moment arm about 
each joint must be calculated for that instant in time. The reason for this is that as the 
leg undergoes its motion, a linear actuator will not maintain a constant perpendicular 
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distance from the Joint. Thus, whether a specified actuator will provide the prescribed 
motion is a function of two variables: torque required and perpendicular distance. To 
determine if the actuator will work, the two worst cases must be compared the actuator 
specifications. If the actuator Is able to provide the necessary linear force and velocity 
for the two cases of maximum torque and minimum perpendicular distance, then the 
actuator wilt work. 

Ji /mg Motion 

The jump motion is described in detail in the another section of this paper and will 
not be redefined here. The dynamic model for this motion is one that provides linear 
motion of the hip Joint (and thus the central body) as compared to the foot Thus, the 
kinematic model for this motion is an off-set slider crank mechanism where the input Is 
from the hip Joint and the knee joint is a passive Joint 

The solution to this kinematic problem was implemented In a computer program In 
order to solve for the angular velocities and accelerations of each Joint These values 
were very Important In order that the dynamic problem could be solved completely. To 
accomplish this, the Newtonian Force equations were derived for the linkage so that the 
torque about each of the joints could be solved tor as a function of its position. 

Lean Motion 

As with the Jump motion, the lean motion is described In detail else where in this 
paper. For this problem, the motion is modeled as a four-bar linkage where the joints 
are comprised of: 

1) Tibia 


2) Femur 
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3) Rigid structure consisting of everything but links 1 and 
2 (the rest of SKITTER) 

4) Ground 

The kinematic solution to this problem Is also well known but with one small 
difference: the input to the system undergoes a constant acceleration. While this Is not a 
drastic change in the problem, it does considerably complicate the solution. With tfw 
accomplished, the next task was to derive the dynamic solution to determine the Inptf 
torque needed to generate the angular velocities calculated by the kinematic equations as 
necessary to move SKITTER. Again using Newtonian mechanics and the angular 
accelerations and velocities from the kinematic problem, a system matrix of rank nine 
was derived that had to be solved to determine the input torque. The system matrix, white 
not triangular, was solvable using Gaussian elimination with row pivoting to obtain a 
solution to the Input torque needed at the hip Joint to provide the desired motion. 

Rsaulta 

Presented below are the results of the numerical calculations and simulations 
performed under this contract. All of the number represent the power requirements of 
SKITTER while operating on earth and with a weight of three hundred pounds. 

Jump Motion 


Sample data presented below is fromthe computer simulation of the dynamics of 
SKITTER. The family of curves shown below is for a variety of jump heights and 
acceleration distances. The physical parameters for the SKITTER model were detemned 
from the envisioned SKITTER II model. The values shown are the requirements for each 
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leg as it attempts to jump. The total system requires three times as much torque and 
horse power to jump the distance desired. 

The first plot shows a family of curves for the input torque at the hip joint at various 
jump distances and acceleration distances. 



Aooffcration Distant* ( (nj 


The following plot shows required maximum angular velocity at the hip joint to 
acclerate SKITTER to jump various heights through different acceleration distances. 
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As can be seen from these plots, the requirements to Jump are not as streneous as 
originally thought. Sizing actuators to meet these specifications Is not difficult and a 
vendor has already been Identified that can meet these requirements. The Helac 
Corporation makes a series of planetary rotary actuators that are capable of suppling 
4300 inch-pounds of torque with a full 360 degrees of rotation In the Joint, while 
weighing only 24 pounds. These actuators will be ideal choice for use on SKITTER II. 

LUO. Motion 

For the lean motion, a family of curves was generated for various angles of 
acceleration (this is the angle that SKITTER accelerates through till it reaches the desired 
angular velocity to lift off from the ground) and ground clearances (the distance that the 
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loot is from the ground at its maximum point). It is important to note that this 
simulation is (or the case where one leg Is providing the force to rotate SKITTER about the 
other two legs. In the crutch walk motion described earlier, It is also desired lor the 
other two legs to push oil (rom the ground and rotate about the stationary third leg during 
part ol Its motion. For this case, the angular velocity about each ol the moving legs hip 
Joint is the same whether one or two legs Is pushing, but the torque can be divided 
between the two legs. Thus, the angular velocity requirements stay the same for this 
motion, but the torque requirements are divided between the two legs. 

The first plot illustrates the family of curves relating the maximum Input torque at 
the hip Joint for a variety ol accleratlon angles and ground clearances (the distance that 
the loot of SKITTER leaves the ground during the rotation motion). 
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The data presented here has been checked in various manners. For the lean motion, 
graphical techniques were used to verify the angular velocities and accelerations 
generated by the computer program. Since these numbers are then used to determine the 
Input torque, this number is believed to be correct also. 

Future Work 

The work completed under this contract to develop kinematic and dynamic equations 
for the motions of SKITTER has been completed. Actuator sizing programs have been 
developed so that the designer can vary the size of the structural members and optimize 
the power consumption for a given size actuator. The joint angles from the jump and lean 
motions can also be written to a file so that the graphical simulation program can display 
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the motions of SKITTER In 3-D. The next step In this process is to Improve the computer 
models and Incorprate In the program a control algorithm and Inefficiencies In the power 
transmission. This will give the most accurate computer simulation of what the actual 
SKITTER II will be like when It eventually Is built. Again, by using the computer 
simulations, the designer Is able to optimise the design before any hardware Is built. 

This allows the best prototype to be built. 
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£ model 


To teit the theory on the motloo of a three-legied walker, a proof of principle working 
model was constructed. The walker was a one-tenth scale model of the conceptual design of 
the Lunar model aid its purpose was only to obtain some translatory motion. This model, 
which weighed approximately eighty-five pounds and was completely self-contained, was 
demonstrated to NASA on several occasions where it fulfilled its intended goal and also 
demonstrated several other of the modes of operation dismissed earlier. 


The SK I TTE R proof of principle model was pneumatically actuated for cost effective 
reasons. A small scuba tank was attached to the underside of the model to serve as a high 
pressure reservoir of air. With a pneumatic actuation system, each actuator was only able to 
move the joint into two discrete positions, either the actuator was all the way in or all the way 
out (as compared to hydraulic or electromechanical actuators that can reach an infinite number 
of positions over its stroke length). Since the original design called for two actuators per leg, 
this results in four positions of the foot. To improve on this, the design for the prototype was 
modified such that each joint consisted of two actuators, four actuators per leg. and the 
actuators were connected by a free floating member. This gave each joint four possible 
positions that it could obtain and thus the foot could obtain sixteen different positions. 

To control the actuation of the joints, a small computer was located aboard the model. 
Since no usable position or velocity feedback can be obtained from a pneumatic actuator, the 
computer was programed with a series of commands that controlled the actuators and therefore 
the walker could demonstrate the modes of operations discussed earlier. 


There are a number of fundamental differences between the proof of principle model and 
the SKITTER proposed for use on the moon. The first difference is that the prototype 
operated outside of its intended environment on the moon where the gravity is one-sixth’s of 
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the earth’s gravity. Thus, the power requirements were much higher on the prototype as 
compared to a comparable SKITTER on the moon. The second difference b that the prototype 
used a discrete actuation system that allows the feet to be in only sixteen discrete motions. Of 
those positions, only certain movements from these discrete positions allowed the prototype to 
move as designed. The final difference was that no control strategy could be Implemented to 
provide smooth motion of the legs because of the pneumatic system’s lack of useful feedback. 


The fact that a successful prototype was built and demonstrated with these negative 
factors inhibiting its performance, shows that the idea b feasible and much easier to implement 
than originally thought. With the addition of servo-actuators, the motion can only be 
improved, but the fundamental concepts on the modes of operation of a three-legged walker 
have already been proved correct 




With a successful proof of principle model developed, the Georgia Institute of Technology 
b continuing the development of the three-legged walker. SKITTER. To further a complete 
understanding of the dynamics and kinematics of the walker, computer simulation b being 
written to incorporate the equations of motion and dbpby graphically SKITTER as it moves. 
Once this work has been completed, a control strategy and hardware (actuators and sensors) will 
be incorporated into the computer mode! to provide a realistic simulation of the next generation 
prototype. This model can then be evaluated and modified by the user before any hardware is 

actually built. 

The next version of SKITTER, or SKITTER II. will have servo-actuators at the joints to 
allow feedback of the position and velocity of the joint so that the motion of the legs can be 
accurately controlled throughout the range of their motions. This new model will be capable of 
all the gaits and modes of operation described previously, but it will have much greater range 
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of motion and a much smoother motion. This next generation SKITTER model will also be 
compared against other walking and wheeled vehicles for overall efficiency, as well as the 
accuracy of the computer models. 
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SKIT_3D 

Three Dimensional Graphic Simulation Program 

Computer graphic simulation is an excellent engineering tool tor analyzing and 
designing spatial mechanisms. SKIT_3D Is a three dimensional graphic simulation 
program which allows the user to visualize SKITTER'S spatial configurations by 
controlling system, leg segment, or actuator movements of a screen representation of the 
platform. User Input Is In the form of Incremental positioning, direct positioning, or 
time based data files which can be used for platform animation. Output Is directed to a 
screen, plotter, or dump device. 

SYSTEM REQUIREMENTS: 

Computer: Hewlett-Packard 200 or 300 series computer with Input knob 

present on the key board. 

Mass Storage: One 3.5* 720 kbyte disc drive. 

Software: Hewlett-Packard Basic 4 0 or greater with the Knob_20 bin 

loaded. 

Options: Hewlett-Packard Graphics Language (HPGL) plotter. 

Hewlett-Packard LaserJet printer (or equivalent). 

1 THE PROGRAM: 

To load the program: 

1 ) Boot the computer into the Basic System environment. 

2) Make the disc drive the default mass storage device by using the Mass 
Storage Is command. 

3) Insert the SKIT_3D disc into the disc drive. 

4) Type load "SKIT_3D” <cr>. 


5) Hit <RUN> Key. 

6) Program will begin. 


using THE PROGRAM: 

The Program can be divided Into two different sections depending on the type of 
data input. The Manual Mode of operation allows the user to input data directly or via the 
keyboard knob to control SKITTER’S movements while the Data FHe Mode accepts time 
based data files for animating platform position sequences. All mnvflfTlflnta by tt ifl 
platform arfl relat e J ft » coordinate smm on SK1TIEB- Figure 3 shows the 

orientation of the coordinant system ( x-y-z) relative to the Initial screen display. 

MANUAL MODE 

Main iteiuu 

The Initial display shows a Z axis view of SKITTER with the main menu 
appearing at the bottom of the screen. The menu Hems can be accessed by pressing the 
corresponding function keys on the key board. Definition of the keys are as follows 

SYSTEM: Allows the user to reorient the entire platform. 

PIVOT LINES: Allows the user to pivot the entire platform about a line 
constructed by any two feet of SKITTER. 

ACTUATORS: Allows the user to reorient either a leg segment or the entire 
platform by engaging a particular actuator. 

EXIT: Allows the user to exit the program. 

OUTPUT: Allows the user to output the screen display to either a plotter or 
dump device. 

MOVIE: Allows the user to enter DATA FILE Mode. 


ATTRIBUTES: Allows Ihe user to change views, window parameters, and 
output devices. 

WHAT: Allows the user to view screen, output device, and platform 
parameters. 


SVSTEM : 

The SYSTEM function allows the user to rotate or translate the entire platform about 
or along all three axis. When the key Is pressed, a new menu win appear and is defined as 

follows: 

Rotate X: Rotates the platform incrementally about the X axis when the knob 
la turned. 

Rotate Y: Rotates the platform incrementally about the Y axis when the knob 
is turned. 

Rotate Z: Rotates the platform incrementally about the Z axis when the knob 
is turned. 

Rotation Angle: Rotates the platform about the last rotation axis by a user 
defined angle (<cr> quits). 

Knob Increment: Allows the user to Input a new knob increment. 

Translate X: Translates the platform Incrementally along the X axis when 
the knob is turned. 

Translate Y: Translates the platform incrementally along the y axis when 
the knob is turned. 

Translate Z: Translates Ihe platform incrementally along the z axis when 
the knob is turned. 

Trans Vector: Translates the platform along a user defined vector (<cr> to 
quit) 

Main Menu: Returns the user to the main menu. 


Pivot Lines: 

The PIVOT LINES function allows tha usar to pivot the entire platform about a line 
constructed by two of SKITTER’S feet. When the key Is depressed, a new menu will appear 
and is defined as follows: 

Leg A: Pivots the platform about the leg a pivot line constructed by the feet 
of legs b & c. 

Leg B: Pivots the platform about the leg b pivot line constructed by the feet 
of legs a & c. 

Leg C: Pivots the platform about the leg c pivot line constructed by the feet of 
legs a & b. 

Main Menu: Returns the user to the main menu. 

ACTUATORS: 

The ACTUATORS function key allows the user to reorient a leg segment or the entire 
platform by engaging a particular actuator. When the key Is depressed a new menu 
appears and is defined as follows: 

Femur A: Engages the femur a actuator and will incrementally change the 
femur a-body angle when the knob is turned. 

Femur B: Engages the femur b actuator and will incrementally change the 
femur b-body angle when the knob is turned. 

Femur C: Engages the femur c actuator and will incrementally change the 
femur c-body angle when the knob is turned. 


Fixed/Frea: A Toggle switch which allows the user to move the platform 
with either its legs always In contact with the ground (fixed) 
or unconstrained by the ground (free). 

Knob Increment: Allows the user to define a new Knob increment. 

Tibia A: Engages the tibia A actuator and wM incrementally change the 
tibia-femur angle of leg a when the Knob Is turned. 

Tibia B: Engages the tibia b actuator and wW incrementally change the 
tibia-femur angle of leg b when the Knob Is turned. 

Tibia C: Engages the tibia c actuator and wifl incrementally change the 
tibia-femur angle of leg c when the Knob is turned. 

Main Menu: Returns the user to the main menu. 

OUTPUT: 

The OUTPUT function Key allows the user to send the screen display to a plotter or a 
dump device. When the Key Is pressed, a new menu wiH appear and is defined as follows: 
Plotter: Outputs the screen display to the designated plotter. 

Raster Dump: Outputs the screen display to the designated dump device. 
Main Menu: Returns the user to the main menu. 


ATTRIBUTES: 

The ATTRIBUTES key allows the user to define views, window parameters, and output 
devices. When the key is pressed, a new menu will appear and is defined as follows: 

View: Allows the user to define a new view. When this key is depressed, a 
new menu will appear and is defined as follows: 

X Axis: Changes the users view to looking down the X axis. 

Y Axis: Changes the users view to looking down the Y axis. 

Z Axis: Changes the users view to looking down the Z axis. 



Quit: Returns the user to the ATTRIBUTES menu. 

Window: Allows the user to change window parameters. When this key Is 
pressed, a new menu will appear and is defined as follows: 

Zoom: Allows the user to zoom in and out from the current window. 
Pan X: Allows the user to pan horizontally. 

Pan Y: Allows the user to pan vertically. 

fc 

Input Data: Allows the user to input specific window coordinants. 
Quit: Returns the user to the ATTRIBUTES menu. 

Dlsp Quantities: Displays current positions and incremental changes of the 
entire system or body segments as they are moved. 

Dump Device: Allows the user to specify a new dump device. 

Plotter Port: Allows the user to specify a new plotter port. 

Main Menu: Returns the user to the main menu. 

WHAT: 

The WHAT function key allows the user to view the values of all parameters such as 
Joint angles, output devices, window variables, and current view. To exit to the main 
menu, simply hit <cr>. 


DATA FILE MODE 

The MOVIE key accessible on the main menu allows the user to enter DATA FILE 
MODE. This mode of operation accepts time based data files created previously by the 
user and determines the transformation matrices for each time increment. A new file is 
built on the disc drive named SKITWORKS which contains the SKITTER position sequence. 


After the SKITWORKS tile Is closed the program begins animating the position sequence on 
the screen. 

The DATA FILE mode is extremely useful for integrating output data files from 
kinematic or control programs with computer graphics. The user is able to vary any 
particular parameter, such as mass, Inertia, or gravity in his application program, 
create a Input data file, and see graphically the effects on SKITTER as it goes through a 
position sequence. Once a theoretical SKITTER model is complete design of the system 
components can begin using the model parameters (l.e. control parameters, leg lengths, 
weights etc.) as design constraints. 

INPUT DATA RLE STRUCTURE 

The input file structure consists of values for time, free or fixed leg segment 
movements, and system rotations and translations. The file can be 30 lines long and each 
line is arranged as follows: 

TIME FREE FEMUR TIBIA FEMUR TIBIA FEMUR TIBIA ROT ROT ROT TRAN TRAN TRAN 
A A BB CCXYZXY2 

.2 0 3.2 5 0 0 0 0 15 0 0 0 0 0 

This particular example shows that the user wishes to rotate the system around the x 
axis 15 degrees, move femur a 3.2 degrees in fixed mode.and tibia a 5 degrees in the fixed 
mode at time increment .2. 

TIME: Time can have any value; however the value of 999 is reserved as a pointer to 
tell the program that it is at the end of the input data file. On the final line of the data file 
the user has to make the time value coual to 999. 

FREE: If the value for free equals 0, then the foot will be fixed; however, if the 

value for free equals 1 then the foot is free ( see manual mode - actuators menu). 


When the MOVIE keys is pressed, the user will be asked : 


DO YOU WANT TO RUN AN ALREADY COMPUTED FILE ? Y OR N 

If the user has run the movie function before and as saved a SKITWORKS file, he may 
enter Y. However, If this Is the first time through for the user or a brand new Input file, 
he should enter N. 

At the prompt, enter In the name of either the computed file or new Input file 
depending on your previous answer. The program will proceed and animate the position 
sequence. To stop the animation sequence simply hit <cr>. 

Once the animation sequence Is stopped, the program will ask the user if he would like 
to save the SKITWORKS file as a computed file If the input data file was new. If so enter Y 
and enter the name of the file at the next prompt. 

A sample Input file , SHOW, and a computed file, WALK, are store on the SKIT_3D 
disc an can be used to demonstrate the DATA FILE mode for the user. 



TRANSLATE X 




ROTATE Z 







ACTUATORS TIBIA A 





VIEW X AXIS 







WINDOWS ZOOM 






NKX 


; 

THESE ARE THE CURRENT PARAMETERS: 


WINDOW: 

X MIN - -20 

X MAX - 40 



Y MIN - -20 

Y MAX - 40 


VIEW: LOOKING 

DOWN Z AXIS 



PLOTTER LOACTION: 705 

PRINTER LOCATION: 9 


DISPLAY VALUES 

IS OFF 



TRANS (in.) 

ROT (deg) 

FEMUR ANGLE 

TIBIA ANGLE 

X 0.00 

0.00 

A 0.00 

90.00 

Y 0.00 

0.00 

B 0.00 

90.00 

Z 0.00 

0.00 

C 0.00 

90.00 


PIVOT ANG A: 0 PIVOT ANG B: 0 PIVOT ANG C: 0 


FORM FEED | LASER PRINTER | SCREEN |HARD DISK |DISK DRIVE 

SCRATCH | LOAD "" j CATALOG DRIVE |LIST PROGRAM | RE-STORE "" 


TYPICAL OUTPUT FROM 'WHAT' COMMAND 


SKIT_3D V.10 

THREE DIMENSIONAL GRAPHIC SIMULATION PROGRAM 

WRITTEN BY: 

BRICE K. MACLAREN 
GARY V. MCMURRAY 
06/23/88 

THIS PROGRAM WILL ACCURATELY DEPICT THE SKITTER MOBILE PLATFORM 
AND THE MOTIONS THAT IT IS ABLE TO ACHIEVE BY USING EITHER 
MANUAL OR DATA FILE INPUT. USE FUNCTION KEYS AND KNOB FOR INPUT. 


REM** 

REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM • 

REM 
REM 
REM 
REM 
REM 
REM 

REM******************** ****** ********************************************* 
REM SKITTER DATA FILE: SEE MANUAL FOR DESCRIPTION OF BODY POINTS 

rem*********************************************************************** 


HARDWARE: 


SOFTWARE : 
OPTIONS: 


HEWLETT PACKARD 200/300 SERIES COMPUTER 
3.5' DISC DRIVE 
KEYBOARD WITH KNOB 

HEWLETT-PACKARD BASIC 4.0 WITH KNOB_2 0 BIN LOADED 

HEWLET-PACKARD (HPGL) PLOTTER 

PRINTER 


*************** A ************************************************ 


DATA 

DATA 

DATA 

DATA 

DATA 

DATA 

1 

DATA 

DATA 

DATA 

DATA 

DATA 

DATA 

1 

DATA 

DATA 

DVTA 

DATA 

DATA 

DATA 

i 

DATA 

DATA 

DATA 

DATA 

DATA 

DATA 

! 


0,0,0,10 

6.5482.28.4912.0, -2 
9.1602,20.9817,3.2283,-1 
-1.7468,20.9817,9.5688,-1 
-3.2741,28.4912,5.6709,-1 
0,0, 0,7 

0 , 0 , 0,10 

-3.2741,28.4912,5.6709,-2 
-7.3759,20.9817,6.3188,-1 
-7.3759,20.9817,-6.3188,-1 
-3 . 2741 ,28.4912,-5. 6709 , -1 
0,0, 0,7 

0 , 0 , 0,10 

-3.2741,28.4912,-5.6709,-2 

-1.7468,20.9817,-9.5688,-1 

9.1602,20.9817,-3.2283,-1 

6.5482.28.4912.0, -1 
0,0, 0,7 

0 , 0 , 0,10 

6.5482.13.4722.0, -2 
9.1602,20.9817,3.2283,-1 
-1.7468,20.9817,9.5688,-1 
-3.2741,13.4722,5.6709,-1 
0,0, 0,7 


UPPER BODY 


A 

H 

I 

B 


B 

J 

K 

C 


C 

L 

G 

A 


D 

H 

I 

E 


BOTTOM BODY 


DATA 

0,0,0,10 




DATA 

-3.2741,13.4722, 

5.6709,-2 

I 

E 

DATA 

-7.3759,20.9817, 

6.3188 . -1 

i 

• 

J 

DATA 

-7.3759,20.9817, 

-6.3188,-1 

i 

K 


*80 

DATA 

-3.2741,13.4722,-5.6709,-1 1 

490 

DATA 

0,0, 0,7 

900 

1 


510 

DATA 

0 , 0 , 0,10 „„ „ . 

520 

DATA 

-3.2741,13.4722,-5.6709,-2 1 

530 

DATA 

-1.7468,20.9817,-9.5688,-1 ! 

540 

DATA 

9.1602,20.9817,-3.2283,-1 

550 

DATA 

6.5482,13.4722,0,-1 

560 

DATA 

0 , 0 , 0 , 7 

570 

l 


580 

DATA 

0,0, 0,4 

590 

DATA 

°,°, °r 10 _ „ 

600 

DATA 

9.1602,20.9817,-3.2283,-2 

610 

DATA 

29.6602,20.9817,-3.2283,-1 

620 

DATA 

18.7362,25.0731,0,-1 

630 

DATA 

0,0, 0,7 

640 

I 


650 

l 


660 

DATA 

0,0,0,10 

670 

DATA 

29.6602,20.9817,3.2283,-2 

680 

DATA 

18.7362,25.0731,0,-1 

690 

DATA 

9.1602,20.9817,3.2283,-1 

700 

DATA 

0,0, 0,7 

710 

l 


720 

DATA 

0,0,0,10 

730 

DATA 

9.1602,20.9817,-3.2283,-2 

740 

DATA 

29.6602,20.9817,-3.2283,-1 

750 

DATA 

20.571,16.8903,0,-1 

760 

DATA 

r- 

o 

o 

o 

770 

! 


780 

DATA 

0,0,0,10 

*90 

DATA 

29.6602,20.9817,3.2283,-2 

800 

DATA 

20.571,16.8903,0,-1 

810 

DATA 

9.1602,20.9817,3.2283,-1 

820 

DATA 

0,0,0, 7 

B30 

l 


840 

DATA 

o 

«« 

o 

o 

►-» 

o 

bso 

DATA 

29.6602,20.9817,-3.2283,-2 

860 

DATA 

30.4255,0,0,-1 

970 

DATA 

35.7901,9.2132,0,-1 

980 

DATA 

0,0,0, 7 

990 

1 


900 

DATA 

o 

iH 

% 

O 

o 

o 

*10 

DATA 

29.6602,20.9817,3.2283,-2 

920 

DATA 

30.4255,0,0,-1 

930 

DATA 

35.7901,9.2132,0,-1 

940 

DATA 

0,0, 0,7 

950 

1 


960 

DATA 

0,0, 0,4 

970 

DATA 

0,0,0,10 

)80 

DATA 

-1.7468,20.9817,9.5688,-2 

>90 

DATA 

-9.3493,25.0731,16.2368,-1 

1000 

DATA 

-11.9968,20.9817,27.3223,- 

L010 

DATA 

0,0, 0,7 

L020 

1 


1030 

DATA 

0,0,0,10 

.040 

DATA 

-17.6259,20.9817,24.0723,- 

.050 

DATA 

-9.3493,25.0731,16.2368,-1 

.060 

DATA 

-7.3759,20.9317,6.3188,-1 

.070 

DATA 

0,0, 0,7 


F 


F 

L 

G 

D 


1 RESERVED FOR PEN 

G 

H 

0 


N 

O 

H 


G 

M 

P 


N 

P 

H 


! 

1 H 
i A' 
! B’ 


1 N 
1 A' 
i B* 


RESERVED FOR PEN 

I 

S 

Q 


R 

S 

J 


FEMUR ONE 


TIBIA ONE 


FEMUR TWO 


1080 

1 



1090 

DATA 

0,0,0,10 


1100 

DATA 

-1.7468,20.9817,9.5688,-2 ! 

I 

1110 

DATA 

-10.2667,16.8903,17.8258,-1! 

T 

1120 

DATA 

-11.9968,20.9817,27.3223,-11 

Q 

1130 

DATA 

0,0, 0,7 


1140 

1 



1150 

DATA 

0,0,0,10 


1160 

DATA 

-17.6259,20.9817,24.0723,-21 

R 

1170 

DATA 

-10.2667,16.8903,17.8258,-11 

T 

1180 

DATA 

-7.3759,20.9817,6.3188,-1 l 

J 

1190 

DATA 

o 

o 

o 


1200 

l 



1210 

! 



1220 

DATA 

0,0,0,10 l 


1230 

DATA 

-11.9968,20.9817,27.3223,-2 1 

Q 

1240 

DATA 

-15.1940,0,26.3601,-1 ! 

C' 

1250 

DATA 

-17.8763,9.2132,31.0059,-1 1 

D' 

1260 

DATA 

0,0, 0,7 


1270 

1 



1280 

DATA 

0,0,0,10 


1290 

DATA 

-17.6259,20.9817,24.0723,-2 l 

N 

1300 

DATA 

-15.1940,0,26.3601,-1 l 

C* 

1310 

DATA 

-17.8763,9.2132,31.0059,-1 

l D' 

1320 

DATA 

0,0, 0,7 


1330 

1 



1340 

DATA 

0,0, 0,4 l RESERVED FOR PEN 

1350 

DATA 

0,0,0,10 1 


1360 

DATA 

-7.3759,20.9817,-6.3188,-2 1 

K 

1370 

DATA 

-9.3493,25.0731,-16.2368,-11 

W 

1380 

DATA 

-17.6259,20.9817,-24.0723,-11 

U 

1390 

DATA 

0,0, 0,7 


1400 

1 



1410 

DATA 

0,0,0,10 


1420 

DATA 

-11.9968,20.9817,-27.3223,-2 1 

V 

1430 

DATA 

-9.3493,25.0731,-16.2368,-1 1 

W 

1440 

DATA 

-1.7468,20.9817,-9.5688,-1 l 

L 

1450 

DATA 

% 

o 

o 

o 


1460 

1 



1470 

DATA 

0,0,0,10 


1480 

DATA 

-7.3759,20.9817,-6.3188,-2 1 

K 

1490 

DATA 

-10.2667,16.8903,-17.8258,-1 1 

X 

1500 

DATA 

-17.6259,20.9817,-24.0723,-1 1 

u 

1510 

DATA 

0,0, 0,7 


L520 

! 



1530 

1 



L540 

DATA 

0,0,0,10 


1550 

DATA 

-11.9968,20.9817,-27.3223,-2 1 

V 

L560 

DATA 

-10.2667,16.8903,-17.8258,-1! 

X 

1570 

DATA 

-1.7468,20.9817,-9.5688,-1 1 

L 

L580 

DATA 

o 

o 

o 


L590 

! 



L600 

DATA 

0,0,0,10 1 


L610 

DATA 

-17.6259,20.9817,-24.0723,-2 1 

U 

(.620 

DATA 

-15.1940,0,-26.3601,-1 1 

E' 

1630 

DATA 

-17.8763,9.2132,-31.0059,-1 1 

F 9 

L640 

DATA 

o 

o 

o 


.650 

• 

• 



.660 

DATA 

0,0,0,10 


.670 

DATA 

-11.9968,20.9817,-27.3223,-2 ! 

V 


TIBIA TWO 


FEMUR THREE 


TIBIA THREE 



1680 

1690 

1700 

1710 

1720 

1730 

1731 

1732 

1733 

1734 

1735 
1740 
1750 
1760 
1770 
1780 
1790 
L800 
L810 
1820 
L821 
L822 

1823 

1824 

1825 
L830 


E* 

F* 


-15.1940,0,-26.3601,-1 
-17.8763,9.2132,-31.0059,-1 
0,0, 0,7 

**************************************************************** 


MAIN PROGRAM 


DATA 
DATA 
DATA 
REM 
! 

I 

R£M**** ********************************************************** ********* 
REM 
REM 
REM 

FEM** ************************** ******************************************* 
OPTION BASE 1 

REAL Skitter (129, 4) ,Newskit (129, 3) I DEFINE VAR 

REAL Trans (4,4), Temp (129,4), Teinpa ( 129 ,4)1 TRANSFORMATION MATRIX 
REAL Total (4,4), Skitmod (129,4) ' ! TOTAL TRANFORM MATRIX 

REAL Femur (31,4) , Femurmod ( 3 1 , 4 ) ,Femurtemp(31,4) 

REAL Tibia (10, 4) ,Tibiatemp(10,4) ,Tibiamod(10,4) 

GOSUB Init 1 INITILIZATION ROUTINE 

CALL Display skit (Skitter (*) ,Newskit(*) , Screen x,Screen_y) 

l DRAW SKITTER 

rem*** *************************** **************************************** 
REM 

REM MENU SELECTION AND KEY DEFINITION 

REM 

REM********************************************************************** 
Menu: l MENU SELECT 


1840 
1850 1 
I860 
L870 
L880 
L890 
1900 
L910 
1920 
L930 
L940 
1950 
I960 
1970 
L980 
1990 
>000 
>010 
>020 
>030 
•040 
>050 
>060 
>070 
>080 
!090 
>100 
!110 
!120 
:130 
140 
150 
160 
170 


SELECT Menu$ 

CASE "MAIN" 

ON KEY 0 LABEL "SYSTEM" GOTO System 
ON KEY 2 LABEL "ACTUATORS" GOTO Actuator 
ON KEY 5 LABEL "OUTPUT" GOTO Output 
ON KEY 7 LABEL "ATTRIBUTES" GOTO Attributes 
ON KEY 9 LABEL "WHAT ??" GOTO What 
ON KEY 4 LABEL "EXIT" GOTO Finished 
ON KEY 1 LABEL "PIVOT LINES" GOTO Pivotlines 
ON KEY 6 LABEL "MOVIE" GOTO Movie 
ON KEY 3 LABEL "" GOTO Main 
ON KEY 8 LABEL "" GOTO Main 
GOTO 1970 
CASE "PIVOTLINES" 

ON KNOB .55 GOTO Knob_isr 
ON KEY 0 LABEL "LEG A" GOSUB Pivotlega 

ON KEY 1 LABEL "" GOTO Pivotlines 

ON KEY 2 LABEL "LEG B" GOSUB Pivotlegb 

ON KEY 3 LABEL "" GOTO Pivot lines 

ON KEY 4 LABEL "LEG C" GOSUB Pivot lege 

ON KEY 5 LABEL "" GOTO Pivotlines 

ON KEY 6 LABEL "" GOTO Pivotlines 

ON KEY 7 LABEL "" GOTO Pivotlines 

ON KEY 8 LABEL "" GOTO Pivotlines 

ON KEY 9 LABEL "MAIN MENU" GOTO Main 
GOTO 2100 
CASE "SYSTEM" 

ON KNOB .2 GOTO Knob_isr 
ON KEY 1 LABEL "ROTATE Y" GOSUB Rot_y 

ON KEY 0 LABEL "ROTATE X" GOSUB Rot_X 

ON KEY 2 LABEL "ROTATE Z" GOSUB Rotz 

ON KEY 5 LABEL "TRANSLATE X" GOSUB Trans_x 

ON KEY 6 LABEL "TRANSLATE Y" GOSUB Trans_y 



(2180 

2190 

2200 

2210 

2220 

2230 

2240 

2250 

2260 

2270 

2280 

2290 

2300 

2310 

2320 

2330 

2340 

2350 

2360 

2370 

2380 

2390 

2400 

2410 

2420 

M30 

2440 

2450 

2460 

2470 

2480 

2490 

2500 

2510 

2520 

2530 

2540 

2550 

2560 

2570 

2580 

2590 

2600 

2610 

2620 

2630 

2640 

2650 

2660 

2670 

2671 

2672 

2673 

2674 
*675 
*676 
*677 
>680 
!690 
.700 


I 


l 

! 


I 


ON KEY 7 LABEL "TRANSLATE 2" GOSUB Trans_Z 
ON KEY 9 LABEL "MAIN MENU" GOTO Main 
ON KEY 8 LABEL "TRANS VECTOR" GOSUB Vector 
ON KEY 3 LABEL "ROTATION ANGLE" GOSUB Angle 
ON KEY 4 LABEL "KNB INCREMENT" GOTO Increment 
GOTO 2230 

CASE "ATTRIBUTES" 

ON KEY 0 LABEL "VIEWS" GOTO Windowpane 

ON KEY 9 LABEL "MAIN" GOTO Main 

ON KEY 1 LABEL "" GOTO Attributes 

ON KEY 2 LABEL "WINDOW" GOTO Windows 

ON KEY 3 LABEL "" GOTO Attributes 

ON KEY 4 LABEL "DISP QUANTITY" GOTO Print_flag 

ON KEY 5 LABEL "DUMP DEVICE" GOTO Printer 

ON KEY 6 LABEL "PLOTTER PORT" GOTO Plotter 

ON KEY 7 LABEL "" GOTO Attributes 

ON KEY 8 LABEL "" GOTO Attributes 

GOTO 2360 


CASE "OUTPUT" 

ON KEY 0 LABEL 
ON KEY 1 LABEL 
ON KEY 2 LACEL 
ON KEY 3 LABEL 
ON KEY 4 LABEL 
ON KEY 5 LABEL 
ON KEY 6 LABEL 
ON KEY 7 LABEL 
ON KEY 8 LABEL 
ON KEY 9 LABEL 
GOTO 2500 


"PLOT" GOTO Plot 

"" GOTO Output 

"RASTER DUMP" GOTO Dump 

"" GOTO Output 

"" GOTO Output 

"" GOTO Output 

"" GOTO Output 

"" GOTO Output 

"" GOTO Output 

"MAIN MENU" GOTO Main 


CASE "ACTUATOR" 

ON KNOB .21 GOTO Knob_leg_isr 
ON KEY 0 LABEL "FEMUR A" GOTO Femur_a 

ON KEY 1 LABEL "FEMUR B" GOTO Femur_b 

ON KEY 2 LABEL "FEMUR C" GOTO Femur_c 

ON KEY 5 LABEL "TIBIA A" GOTO Tibia_a 

ON KEY 6 LABEL "TIBIA B" GOTO Tibia_b 

ON KEY 7 LABEL "TIBIA C" GOTO Tibia_c 

ON KEY 8 LABEL "" GOTO Menu 
ON KEY 3 LABEL Freeleg$ GOTO Free_leg 
ON KEY 4 LABEL "KNB INCREMENT" GOTO Increment 
ON KEY 9 LABEL "MAIN MENU" GOTO Main 
GOTO 2640 
END SELECT 


l 

BFM ****** *********************************************************** ******* 
REM 

REM KNOB ISR: KNOB INTERUPT SERVICE ROUTINE. ON KNOB ROTATION, THE 

REM APPROIPRIATE FUNTION WILL BE CARRIED OUT BY THE KNOB INCREMENT 

REM AMOUNT 

REM 

REM *********************************************************************** 
Knob isr: ! 

Theta=Increment*SGN (KNOBX) 

SELECT TwirlS 


^701 REM************ SYSTEM ROTATION *********************************** 

<702 I 

2710 CASE "ROTATE Y" 

2720 Theta— Theta 

2730 CALL Rotate_y (Skitter (*) ,Skitmod(*) ,Total(*) ,Trans(*) ,Te 

■p(*) ,Tempa(*) ,Sys_rot_y, Theta, Printflag$) 

^731 ! 

^740 CASE "ROTATE X" 

2750 CALL Rotate_x (Skitter (*) ,Skitmod(*) f Total(*) ,Trans(*) ,Te 

mp(*) ,Tempa(*) ,sys_rot_x, Theta, Printflag$) 

2760 1 

2770 CASE "ROTATE 2" 

*2780 CALL Rotate_z (Skitter (*) ,Skitmod(*) , Total (*), Trans (*) ,Te 

»P(*) ,Tempa(*) , Sys_rot_z, Theta, Print flag$) 

2790 1 

2791 REM**************** SYSTEM TRANSLATION ************************************ 

2792 t 

2800 CASE "TRANSLATE" 

2810 CALL Translate_3d(Skitter(*) ,Skitmod(*) ,Total(*) ,Teap(*) 

•^Tempa ( * ) , Trans ( * ) , Sys_trans_x , Sys_trans_y , Sys_trans_z , Way, Theta , Print flag$) 

2820 1 

2821 REM**************** PIVOT LINES ******************************************* 

2822 1 

2830 CASE "PIVOTLINES" 

2840 Theta— Theta 

•6841 ! 

2842 ! 

2850 IF Leg_flag$-" FEMUR A" THEN 

2860 Pivot_ang_a-Pivot_ang_a+Theta 

2870 DISP " MODE: ROTATE ABOUT PIVOT LINE A";Theta;" TOTA 

J, ANGLE:"; Pivot ang a 

^2880 “ “ Pivotx- (Skitter (96,1) +Skitter ( 127 , 1 ) ) /2 

2890 Pivoty- ( Skitter (96,2) +Skitter (127,2) )/2 

2900 Pivotz- (Skitter (96 , 3)+Skitter ( 127 , 3 ) ) /2 

2910 Dist_piv_foot-SQR( (Pivotx-Skitter (65 , 1) ) A 2+(Pivoty-Sk 

itter(65,2) ) A 2+(Pivotz-Skitter(65, 3) ) A 2) 

2920 CALL Trans_f em_orig (Skitter (*) ,Skitmod(*) ,-Pivotx, -Pi 

•voty, -Pivotz) 

2930 Flag-0 

2940 CALL Rotate_leg_z (Skitmod ( * ) , Skitmod ( * ) , Leg$ , -Theta , P 

rintf lag$ , Fem_a_ang , Flag) t 

2950 CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) , Pivotx, Pivo 

ty, Pivotz) 

6^950 MAT Skitter- Skitmod 

2970 END IF 

2980 ! 

2981 ! 

2982 1 

2990 IF Leg_f lag$-"FEMUR B" THEN 

(feOOO P i vo t_ang_b-P i vo t_ang_b+Theta 

3010 DISP " MODE: ROTATE ABOUT PIVOT LINE B BY:";Theta;" 

TOTAL ANG:";Pivot ang b 

3020 “ Pivotx- (Skitter ( 65 , 1)+Skitter( 127 , 1) )/2 

3030 Pivoty- ( Skitter (65,2) +Skitter ( 127 , 2 ) ) /2 

3040 Pivotz- (Skitter (65,3) +Skitter ( 127 , 3 ) ) /2 

fe 0 50 Dist_piv_foot=SQR( (Pivotx-Skitter (9 6, 1) ) A 2+ (Pivoty-Sk 

itter(96 , 2) ) A 2+ (Pivotz-Skitter (96, 3) ) A 2) 

3060 CALL Trans_fem_orig (Skitter (*), Skitmod (*) ,-Pivotx, -Pi 

voty, -Pivotz) 

3070 CALL Rotate_leg_y (Skitmod(*) , Skitmod (*), 60) 


80 

90 , , 
tf lag$ , Fern b ang, Flag) 

00 

10 


CALL Rotate_leg_z ( Skitmod (*) , Skitmod (*) ,Leg$, Theta , Pr 

CALL Rotate legy (Skitmod(*) ,Skitmod(*) ,-60) 

CALL Trana_fem_orig (Skitmod ( * ) , Skitmod ( *) ,Pivotx,Pivo 


, Pivot z) 
20 
30 

40 I 

41 1 

42 1 
50 
60 
70 


HAT Skitter* Skitmod 
END IF 


IF Leg flag$-"FEMUR C" THEN 
Pivot ang c-Pivot_ang c+Theta 

DISP " MODE: ROTATE ABOUT PIVOT LINE C BY: " ; Theta;" 


OTAL ANG : " ; Pivot_ang_c 
80 
90 
00 
1C 


Pivotx- (Skitter ( 65 , 1) +Skitter (96 , 1) ) /2 
Pivoty- ( Skitter (65,2) +Skitter ( 9 6 , 2 ) ) / 2 
Pivotz-(Skitter(65,3)+Skitter(96, 3) )/2 
Dist_piv_foot-SQR( ( Pivotx-Skitter (127 , 1) ) A 2-t- (Pivoty-S 


tt.r(127 , 2) ) -2+ <Pivo«-s*£ter <127, ’> iSkltBod( ., ,- Plvotx , - Pt 


ty, -Pivot z) 

30 

40 

50 

tflag$,Fem c_ang,Flag) 
60 
70 


CALL Rotate_leg_y (Skitmod (*) , Skitmod (*) ,-60) 

Flag»0 

CALL Rotate_leg_z (Skitmod ( * ) , Skitmod ( * ) , Leg$ , Theta , Pr 

CALL Rotate leg_y (Skitmod(*) ,Skitmod(*) , 60) 

CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) , Pivotx, Pivo 


, Pivot z) 

80 
90 
00 I 
10 
20 
30 
40 
50 
60 

70 1 

71 REM********** 


MAT Skitter- Skitmod 
END IF 

MAT Tempa (*,1:3)- Skitter (*,1:3) 

MAT Temp- Tempa *Total 

MAT Skitmod (*,1:3)- Temp(*,l:3) 

END SELECT 

CALL Display_skit ( Skitmod ( *) , Newskit ( * ) , Screen_x , Screen_y) 
GOTO Menu 


i*************** 


KNOB LEG ISR: KNOB LEG INTERUPT SERVICE ROUTINE FOR ACTUATOR MENU 


72 REM 

73 REM 

14 PPM 

75 rem************************************************************************ 

76 1 


30 Knob_leg_isr 

90 

30 

31! 

32 1 
10 
20 
30 
10 


: ! 

Theta=Increment*SGN (KN0BX) 
SELECT Leg$ 


CASE "FEMUR A" 

Theta— Theta 

MAT Femur- Skitter(37:67,*) 

CALL Trans fem_orig ( Femur (*), Femurmod (*), -Femur (3 , 1) , 


smur (3,2) , -Femur (3, 3)) 

SO 

SO 

10 

tntf lag$ , Fem_a_ang , Flag ) 
30 


CALL Rot ate_l eg_y ( Femurmod ( * ) , Femurmod ( * ) , 1 8 0 ) 

CALL Rotate_leg_z (Femurmod (*) ,Femurmod(*) ,Leg$, Theta, 

CALL Rotate_leg_y (Femurmod (*), Femurmod (*) ,180) 



490 

, F«nur(3 , 2 ) , Femur (3,3)) 

900 

510! 

520 

530 

540 

550 

560 

570 

580! 

590 
600 
610 
620 

tter(65,2) ) ' 

630 
640 
650 


CALL Trans_fem_orig (Femurmod ( * ) , Femurmod ( * ) , Femur (3,1 

MAT Skitter (37: 67,*)- Femurmod 

IF Freeleg$«"FREE" THEN 

MAT Femurtemp(*,l:3)- Femurmod (*, 1 : 3 ) 

MAT Femur- Femurtemp*Total 

MAT Skitmod(37:67,l:3)« Femur(*,l:3) 

GOTO End_leg 
END IF 

Pi votx- ( Ski tter ( 9 6 , 1 ) +Skitter ( 12 7 , 1 ) ) / 2 
Pivoty- ( Skitter (96,2) +Skitter ( 127 , 2 ) ) / 2 
Pivot z- ( Skitter (96,3) +Skitter ( 12 7 , 3 ) ) /2 
D i s t_p iv_f oot-SQR ( (Pivotx-Skitter(65, 1) ) A 2+(Pivoty-Sk 
■2+ (Pivotz-Skitter (65, 3) ) A 2) 

Dist_y«Pivoty-Skitter (65,2) 

Rot_ang-ASN ( Dist_y/Dist_piv_f oot ) 

CALL Trans_fem orig (Skitter (*), Skitmod (*), -Pivotx, -Pi 


oty, -Pivot z) 

660 

670 

Printf lag$ , Fem_a_ang , Flag) 


680 


Flag-0 

CALL Rotate_leg_z (Skitmod ( * ) , Skitmod ( * ) , Leg$ , -Rot_ang 
CALL Trans_f era_or ig ( Skitmod ( * ) , Skitmod ( * ) , Pivotx , Pivo 


y,Pivotz) 

690 
700 
710 
720 
730 1 
740 1 
750 ! 

760 

770 

780 

■Femur (3,2) ,-Femur(3,3) ) 
790 
800 
810 

xintf lag$ , Fem_b_ang , Flag) 
820 
830 


MAT Skitter- Skitmod 

MAT Tempa(*,l:3)- Skitter(*,l:3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*,l:3)- Temp(*,l:3) 


CASE "FEMUR B" 

MAT Femur- Skitter (68: 98,*) 

CALL Tra»s_f em_orig ( Femur ( * ) , Femurmod ( * ) , -Femur (3,1), 

CALL Ro t at e_leg_y (Femurmod (*) ,Femurmod(*) ,60) 

Flag-1 

CALL Rotate_leg_z (Femurmod (*) , Femurmod ( *) , Leg$ , Theta , 

CALL Rotate_leg_y (Femurmod (*) ,Femurmod(*) ,-60) 

CALL Trans_f em_orig ( Femurmod ( * ) , Femurmod ( * ) , Femur (3,1 


, Femur (3,2), Femur (3,3)) 

840 

850 ! 

860 
870 
880 
890 
900 
910 
920 ! 

930 

940 

950 

960 


MAT Skitter (68: 98,*)- Femurmod 

IF Freeleg$-"FREE" THEN 

MAT Femurtemp ( * , 1 : 3 ) = Femurmod (*, 1 : 3 ) 

MAT Femur- Femurtemp*Total 

MAT Skitmod(68:98,l:3)= Femur(*,l:3) 

GOTO End_leg 
END IF 

Pivotx- (Skitter (65,1) +Skitter ( 127 , 1 ) ) /2 
Pivoty- ( Skitter (65,2) +Skitter ( 127 , 2 ) ) /2 
Pivot z- ( Skitter (65,3) +skitter ( 12 7 , 3 ) ) / 2 
Dist_piv foot=SQR( (Pivotx-Skitter (96, 1) ) A 2+(Pivoty-Sk 


tter(96,2) ) * 2 + (Pivotz-Skitter (96, ) A 2) 

970 Dist_y=Pivoty-Skitter(96, 2) 

930 Rot_ang=ASN (Dist_y/Dist_piv_foot) 

990 CALL Trans_f em_orig (Skitter (*), Skitmod (*), -Pivotx, -?i 



'Oty, -Pivotz) 

000 

010 

020 

xintf lag$ , Fern b_ang, Flag) 

030 

040 

y, Pivotz) 

050 

060 

070 

080 

090 ! 

100 l 
110 
120 
130 
140 

Panur (3,2) ,-Femur(3 , 3) ) 
150 
160 
170 

rintflag$, Fem_c_ang , Flag) 
180 
190 

, Femur (3, 2) ,Femur(3,3) ) 
200 
210 1 
220 
230 
240 
250 
260 
270 
280 i 
290 
300 
310 
320 


CALL Rot ate_leg_y (Skitmod ( * ) ,Skitmod(*) ,60) 

Flag-0 

CALL Rotate_leg_z (Skitmod (*) , Skitmod (*) ,Leg$, Rot_ang , 

CALL Rotate legy (Skitmod (*) ,Skitmod(*) ,-60) 

CALL Trans_fcm_orig(Skitmod(*) ,Skitmod(*) , Pivotx, Pivo 

MAT Skitter- Skitmod 

MAT Tempa(*,l:3)- Skitter(*,l:3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*,l:3)- Temp(*,l:3) 


CASE w FEMUR C H 
Theta— Theta 

MAT Femur- Skitter (99: 129,*) 

CALL Trans_fem_orig (Femur (*) ,Femurmod(*) ,-Femur(3,l) , 

CALL Rotate_leg_y(Femurmod(*) ,Femurmod(*) ,-60) 

Flag-1 

CALL Rotate_leg_z(Femurmod(*) ,Femurmod(*) , Leg $, Theta, 

CALL Rotate_leg_y ( Femurmod ( * ) , Femurmod ( * ) , 60 ) 

CALL Trans_f em_or ig ( Femurmod ( * ) , Femurmod ( * ) , Femur (3,1 

MAT Skitter(99: 129, *)- Femurmod 

IF Freeleg$-" FREE" THEN 

MAT Femurt emp (*,1:3)- Femurmod (*, 1 : 3 ) 

MAT Femur- Femurtemp*Total 

MAT Skitmod ( 99 : 129 ,1:3)- Femur(*,l:3) 

GOTO End_leg 
END IF 


Pivotx- (Skitter (65,1) +Skitter ( 96 , 1) ) /2 
Pivoty- ( Skitter (65,2) +Skitter ( 96 , 2 ) ) /2 
pivotz— (Skitter (65,3) +Skitter ( 96 , 3 ) ) /2 
Dist_piv_foot-SQR( (Pivotx-Skitter (127 , 1) ) A 2+ (Pivoty-S 

itter ( 127 , 2 ) ) *2+ ( Pivot Z-Skitter ( 127 , 3 ) ) A 2 ) 

330 Dist_y-Pivoty-Skitter(127,2) 

340 Rot ang-ASN (Dist_y/Dist_piv_foot) 

3 50 CALL Trans_fem_orig (Skitter (*), Skitmod (*), -Pivotx, -Pi 

35 o' -PiV ° tZ * CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

370 Flag-0 

300 CALL Rotate_leg_z(Skitmod(*) ,Skitmod(*) ,Leg$,Rot_ang, 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*> ,60) 

Joo CALL Trans_fem_orig (Skitmod (*), Skitmod (*), Pivotx, Pivo 


y, Pivotz) 

410 

420 

430 

440 

450 1 

460 ! 

470 ! 

480 

490 


MAT Skitter- Skitmod 

MAT Tempa(*,l:3)= Skitter(*,l:3) 

MAT Temp- Tempa*Total 

MAT Skitmod (*, 1:3)- Temp(*,l:3) 


CASE "TIBIA A" 
Theta—Theta 



500 

510 

Tibia (2, 2) , -Tibia (2, 3) ) 

520 

530 

540 

rintflag$,Tib a ang,Flag) 

550 

560 

,Tibia(2,2) ,Tibia(2 , 3) ) 

570 

580 ! 

590 
600 
610 
620 
630 
640 
650 1 
660 
670 
680 
690 


MAT Tibia- Skitter (58: 67,*) 

CALL Trans_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 
Flag-1 

CALL Rotate_leg_y (Tibiamod (*) ,Tibiamod(*) ,180) 

CALL Rotate_leg_z (Tibiamod (*) ,Tibiamod(*) ,Leg$, Theta, 

CALL Rotate_leg_y (Tibiamod (*) ,Tibiamod(*) ,180) 

CALL Trans_fera_orig (Tibiamod (*) , Tibiamod (*) , Tibia (2,1 

MAT Skitter(58:67,*)- Tibiamod 

IF Freeleg$-"FREE" THEN 

MAT Tibiatemp(*,l:3)- Tibianod(*,l:3) 

MAT Tibia- Tibiatemp*Total 

MAT Skitmod (58: 67,1:3)- Tibia(*,l:3) 

GOTO End leg 
END IF 


Pivotx- (Skitter (96, 1) +Skitter ( 127 , 1) ) /2 
Pivoty- (Skitter (96,2) +Skitter ( 127 , 2 ) ) / 2 
Pivotz— ( Skitter (96,3) +Skitter ( 127 , 3 ) ) /2 
Dist_piv_foot-SQR( ( Pivotx-Skitter (65,1) ) A 2+ (Pivoty-Sk 
tter(65,2) ) A 2+(Pivotz-Skitter(65,3) ) A 2) 

700 Dist_y-Pivoty-Skitter (65,2) 

710 Rot ang-ASN (Dist_y/Dist_jpiv_foot) 

720 CALL Trans_fem_orig (Skitter (*) ,Skitmod(*) , -Pivotx, -Pi 

Dty, -Pivotz) 

730 Flag*0 

740 CALL Rotate_leg_z (Skitmod ( *) , Skitmod ( * ) , Leg$ , -Rot_ang 

Printflag$,Tib a ang,Flag) 

750 CALL Trans_fem_orig (Skitmod (*), Skitmod (*), Pivotx, Pivo 

f, Pivotz) 

760 
770 
780 
790 
300 ! 

310 ! 

320 
330 
340 

Tibia(2,2) ,-Tibia(2,3) ) 

350 
360 
370 

rintf lag$ , Tib_b_ang , Flag) 

380 
390 

.Tibia (2, 2) , Tibia (2 , 3) ) 

>00 
>10 1 
>20 
>30 
>40 
>50 
>60 
>70 
•80 ! 

•90 


MAT Skitter- Skitmod 

MAT Tempa(*,l:3)- Skitter(*,l:3) 

MAT Temp- Tempa*Total 

MAT Skitmod (*,1:3)- Temp(*,l:3) 


CASE "TIBIA B" 

MAT Tibia- Skitter (89: 98,*) 

CALL Trans_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 

CALL Rotate_leg_y (Tibiamod (*) ,Tibiamod(*) ,60) 

Flag-1 

CALL Rotate_leg_z (Tibiamod (*) , Tibiamod (*) ,Leg$, Theta, 

CALL Rotate_l eg_y (Tibiamod (*) ,Tibiamod(*) ,-60) 

CALL Trans_fem_or ig (Tibiamod (*) , Tibiamod (*) , Tibia (2,1 

MAT Skitter (89: 98,*)- Tibiamod 

IF Freeleg$="FREE" THEN 

MAT Tibiatemp(*,l:3)- Tibiamod (*, 1:3) 

MAT Tibia- Tibiatemp*Total ; 

MAT Skitmod (89 :98,1:3)= Tibia(*,l:3) 

GOTO End_leg 
END IF 


Pivotx- (Skitter (65, 1) +Skitter ( 127 , 1) )/2 



Pivoty- (Skitter (65, 2) +Skitter ( 127 , 2 ) /2 
Pivotz-(Skitter(65,3)+Skitter(127 , 3) )/2 
Dist_piv_foot-SQR( (Pivotx-Skitter(96, 1) ) A 2+(Pivoty-Sk 

: t ter (96 , 2) ) A 2+ (Pivotz-Skitter (96, 3) ) A 2) 
cno n Dist_y-Pivoty-Skitter(96,2) 

Rot ang-ASN (Dist_y/Dist_piv_f oot) 

CALL Trans_fem_orig (Skitter (*) , Skitmod (*) , -Pivotx, -Pi 


(040 
(050 
roty, -Pivot z) 

•060 

(070 

(080 

»rintf lag$ , Tib_b_ang , Flag) 
>090 
>100 

:y. Pivot z) 

(110 
(120 
(130 
(140 
(150 1 
(160 I 
•170 
(180 
(190 

•Tibia (2, 2) , -Tibia (2, 3) ) 
(200 
(210 
(220 

>rintflag$ , Tib_c_ang , Flag) 

(230 

(240 

,Tibia(2 , 2) ,Tibia (2 , 3) ) 
(250 
(260 1 
(270 
(280 
(290 
(300 
(310 
(320 
(330 ! 

(340 
(350 
(360 
(370 


•itter (127,2) ) A 2 +( Pivotz-Skitter (127, 3) ) A 2) 


CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,60) 

Flag-0 

CALL Rotate_leg_z (Skitmod ( *) ,Skitmod(*) ,Leg$,Rot_ang, 

CALL Rotate leg_y (Skitmod(*) ,Skitmod(*) , -60) 

CALL Trans_fem_orig(Skitmod(*) , Skitmod (*) ,Pivotx,Pivo 

MAT Skitter- Skitmod 

MAT Tempa(*,l:3)« Skitter(*,l:3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*, 1:3)- Temp(*,l:3) 


CASE "TIBIA C" 

MAT Tibia- Skitter (120: 129, *) 

CALL Trans_fem_orig (Tibia (*) ,Tibiaraod(*) , -Tibia (2,1) , 

CALL Rotate_leg_y (Tibiamod (*) ,Tibiamod(*) ,-60) 

Flag-1 

CALL Rotate_leg_z (Tibiamod (*) ,Tibiamod(*) ,Leg$, Theta, 

CALL Rotate_leg_y(Tibiamod(*) ,Tibiamod(*) ,60) 

CALL Trans_fem_orig (Tibiamod (*) ,Tibiamod(*) , Tibia (2 , 1 

MAT Skitter (120: 129,*)- Tibiamod 

IF Freeleg$-"FREE" THEM 

MAT Tibiatemp(*,l:3)- Tibiamod (*, 1: 3) 

MAT Tibia- Tibiatemp*Total 

MAT Skitmod (120: 129, 1:3)- Tibia(*,l:3) 

GOTO End_leg 
END IF 

Pivotx- ( Skitter (65,1) +Skitter ( 96 , 1 ) ) / 2 
Pivoty- ( Skitter (65,2) +Skitter ( 9 6 , 2 f ) /2 

Pivot z= ( Skitter ( 65 , 3 ) +Skitter ( 9 6 , 3 ) ) /2 

Dist piv_f oot— SQR ( ( Pivotx-Ski tt er ( 127 , 1) ) A 2+ (Pivoty-S 


(380 
(390 
(400 

•oty, -Pivot z) 

•410 

•420 

430 

Tint f lag $ , Tib_c_ang , Flag) 

440 

450 

y,Pivotz) 

460 

470 

480 


Dist_y=Pivoty-Skitter(127 , 2) 

Rot ang-ASN (Dist_y/Dist_piv_f oot) 

CALL Trans_fem_orig (Skitter (*) ,Skitmod(*) , -Pivotx, -Pi 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

Flag-0 

CALL Rotate_leg_z (Skitmod (*), Skitmod (*) , Leg$ , Rot_ang , 

CALL Rotate_leg_y( Skitmod (*) ,Skitmod(*) ,60) 

CALL Trans_f em_orig (Skitmod ( * ) , Skitmod ( * ) , Pivotx , Pivo 

MAT Skitter- Skitmod 

MAT Tempa ( * , 1 : 3) = Skitter(*, 1:3) 

MAT Temp- Tempa*Total 


MAT Skitmod (*,1:3)- Temp(*,l:3) 


M90 

5500 

5510 

5520 

5550 

5540 

5550 

9551 

5552 

5553 

5554 

5555 
5560 
9570 
5580 
5590 
5600 
5610 
5620 
9630 
5640 
5650 
5660 
5670 
(£80 
9690 

5700 
5710 
5720 
5730 
5740 
^50 
5760 
5770 
5780 
5790 
5800 
RlO 
5820 
5830 
>840 
5850 
5860 
Ib70 
5880 
5890 
5900 
5910 
5920 
• fe30 
5940 
5950 
5960 
>970 
>980 
fc90 
>000 
>010 
;o20 

>030 


1 

End leg: 1 

END SELECT 

I 

CALL Display _ekit (Skitmod (*) ,Newskit(*) ,Screen_x,Screen_y) 
GOTO Menu 


REM **> 

REM 

REM 

REM 

REM*** 

Main: ! 


Movie: t 


GOSUB ROUTINES FOR MENU AND KNOB ISR CASE SELECTION 


Menu$-”MAIN" 
GOTO Menu 


CALL Movie 
RESTORE 160 
GOSUB Init 

CALL Display_skit(Skitmod(*) ,Newskit(*) ,Screen_x,Screen_y) 
GOTO Menu 

Pivotlines: 1 

Menu$-”PIVOTLINES” 

GOTO Menu 

! 

Pivotlega: ! 

Twirl $“” PIVOTLINES" 

Leg_flag$-”FEMUR A" 

RETURN 

! 

Pivotleab: 1 

Twirl$-”PIVOTLINES” 

Leg_flag$-"FEMUR B” 

RETURN 

! 

Pivot lege: 1 

Twi r 1 $- " PIVOTLINES ” 

Leg_flag$“”FEMUR C” 

RETURN 


! 

System: 1 


Menu$-"SYSTEM" 
GOTO Menu 


1 

Attributes : I 

Menu$”" ATTRIBUTES” 

GOTO Menu 

1 

Output: 1 

Menu$="OUTPUT” 

GOTO Menu 

! 

Actuator: ! 

Menu$=”ACTUATOR" 

GOTO Menu 

! 

Increment: ! 

DISP ” INPUT NEW INCREMENT CURRENT VALUE: ", Increment ; 
LINPUT Increments 


5040 IF Increment$-" H THEN 

5050 GOTO 6090 

5060 ELSE 

5070 Increment-VAL ( I ncrement $ ) 

S080 END IF 

*090 GOTO Menu 


>100 Free_leg:l 
>110 
>120 
>130 
>140 
>150 
>160 
>170 
>180 

>190 Femur_a:l 
>200 
>210 
>220 
>230 1 

>240 Femur_b: l 

>250 

>260 

>270 

>280 1 

>290 Femur_c:l 

>300 

>310 

>320 

>330 1 

>340 Tibia_a:l 

>350 

>360 

>370 

>380 1 

>390 Tibia_b:l 

>400 

>410 

•420 

•430 ! 

1440 Tibia_c: 1 

•450 

.460 

.470 

>480 i 


IF Freeleg$-"FIXED" THEN 

DISP " LEG IS NOW FREE TO ROTATE" 

Freeleg$-"FREE" 

ELSE 

DISP " LEG IS NOW FIXED " 
Freeleg$-"FIXED" 

END IF 
GOTO Menu 

Leg $-" FEMUR A" 

DISP " MODE: FEMUR A" 

GOTO Menu 


Leg $-" FEMUR B" 

DISP " MODE: FEMUR B" 
GOTO Menu 


Leg$-"FEMUR C" 

DISP " MODE: FEMUR C" 
GOTO Menu 


Leg$-"TIBIA A" 

DISP " MODE: TIBIA A" 
GOTO Menu 


Leg$-"TIBIA B" 

DISP " MODE: TIBIA B" 
GOTO Menu 


Leg$-"TIBIA C" 

DISP " MODE: TIBIA C" 
GOTO Menu 


J490 Windows : 1 , . „ . 

;5 00 CALL Zoom_pan (Window$ , Screenx_win_min , Screenxwinmax , Screenywi 

i_min , Screeny_win_max , Skitmod ( * ) ,Newskit(*) # Screen_x,Screen_y) 

;510 GOTO Menu 


.520 What: i 


.530 

.540 

550 

560 

570 

580 

590 

600 

610 

620 


Ap=Screenx_win_min 

Bp=Screenx_win_max 

Cp=Screeny_win_min 

Dp=Screeny_win_max 

Ep=Sys_trans_x 

Fp=Sys_trans_y 

Gp=Sys_trans_z 

Hp=Sys_rot_x 

Ip=Sys_rot_y 


fe630 Kp-sys_rot_z 

6640 Lp-F«m_a_ang 

6650 Mp-Fem_b_ang 

6660 Np-Fem_c_ang 

6370 Op-Tib_a_ang 

6660 Qp-Tib_b_ang 

£690 Pp-Tib_c_ang 

6700 Rp-Increment 

6710 Sp-Pivot_ang_a 

6720 Tp-Pivot“ang_b 

6730 Up-Pivot ang_c 

6740 CALL What ( Ep , Fp , GpTHp , Ip , Kp , Ap , Bp , Cp , Dp, Print flag$ , Screen_x , Screen_y , Plot_d 
£vice , Dump_device , Lp , Mp , Hp , Op , Qp , Pp , Rp > Sp , Tp, Up) 

6750 GOTO Menu 

6760 ! 

6770 Windowpane:! 

6780 CALL Windows (Skitmod(*) ,Newskit(*) ,Screen_x,Screen_y) 

6790 GOTO Menu 

£aoo 1 

6810 Window limits: l 

6820 ~ CALL Window_limits (Skitmod<*) ,Newskit (*) ,Screen_x,Screen_v ,Sc 

reenx_win_min , Screenx_win_max , screeny_win_min , Screeny_win_max) 

6830 GOTO Menu 

6840 ! 

^850 Print flag: ! 

“ IF Printflag$-"OFF" THEN 

DISP " DISPLAY QUANTITIES IS ",*CHR$(129) »" ON ";CHR$(126) 
Printflag$-"ON" 

ELSE 

DISP " DISPLAY QUANTITIES IS OFF" 

Print flag$-"OFF" 

END IF 
GOTO Menu 

Twirl$-"ROTATE Y" 

DISP " MODE: ";Twirl$ 

RETURN 


Twirl $-"ROTATE X" 
DISP " MODE: " ;Twirl$ 
RETURN 


Twirl$="ROTATE 2" 
DISP " MODE: ";Twirl$ 
RETURN 


Twirl $-"TRANSLATE" 

DISP " MODE: TRANSLATE X" 

Way-1 

RETURN 


Twirl $="TRANSLATE" 

DISP " MODE: TRANSLATE Y" 
Way =2 
RETURN 

7200 ! 


6860 

6870 

6880 

6890 

6900 

^910 

6920 

6930 

6940 Rot_y: ! 
6950 
6960 
^970 
6980 ! 

6990 Rot x: ! 

7000 

7010 

7020 

J030 ! 

7040 Rot_z: 1 

7050 

7060 

7070 

7080 ! 

J090 Trans_x: ! 
^100 
7110 
7120 
7130 
7140 ! 

.7150 Trans_y: ! 

*7160 

7170 

7180 

7190 


|I7210 Trans_z : ! 
7220 
7230 
7240 
7250 
7260 1 


Tvirl$-"TRANSLATE" 

DISP " MODE: TRANSLATE Z" 

Way-3 

RETURN 


f 270 Vector:! 
7280 
7290 


DISP " MODE: VECTOR TRANSLATION" 

CALL Vector (Skitter (*) ,Skitmod(*) ,Temp(*) ,Tempa(*) , Total (*) ,Tran 
• ( * ) t sy s_trana_x , Sye_trans_y , Sya_tran_z , Nevekit ( * ) , Screen_x , Screen_y , Print f lag$ ) 
7300 RETURN ~ 

7310 I 

g 320 Angle:! 

^330 DISP " MODE: INPUT ANGLE ROTATION" 

7340 CALL Angle (Skitter (*) ,Skitmod(*) ,T«np(*) ,Tempa(*) ,Total(*) ,Trans(*) ,S 

ys rot x, Sys rot_y , Sys_rot_z , Newskit ( *) ,Screen_x,Screen_y,Printflag$,Tvirl$) 

"** nnrmtmt 


7350 

7360 

370 


RETURN 




j80 Plot: ! 


7381 

7382 

7383 

7384 

7385 
v386 
7387 
7390 
7400 
7410 
.7420 

7430 

7431 

7433 

7434 

7435 

7436 

7437 
7440 
7450 
7460 
7470 
7480 
7490 
7500 
7510 
7520 
7530 
7540 
7550 
7560 
7570 
7580 
7590 
7600 
9610 
7620 
7630 

7640 

7641 


CALL Plot_it (Plot_device) 

PLOTTER IS Plot_device,"HPGL" 

DISP "PLOT BEING GENERATED" 

CALL Display_skit (Skitmod ( *) ,Newskit(*) ,Screen_x,Screen_y) 
PLOTTER IS CRT, "INTERNAL" 

PRINT "IN;ROO;IP;UP;SPO;" 

PRINTER IS CRT 
BEEP 1464. 84,. 5 
DISP " PLOT FINISHED" 

GOTO Menu 
l 

Dump: ! 

DISP "GRAPHICS DUMP BEING GENERATED" 

DUMP DEVICE IS Dump_device 
DUMP GRAPHICS 
PRINTER IS Dump_device 
PRINT CHR$ (12) 


PRINTER IS CRT 
BEEP 1464.84, .5 
DISP " GRAPHICS 
GOTO Menu 


DUMP FINISHED" 


1 

Printer: ! 

DISP "WHERE IS THE LOCATION OF THE EXTERNAL PRINTER"; 

LINPUT Temp$ 

IF Temp$-"" THEN GOTO 7540 
Dump device«VAL(Temp$) 

DISP - " PRINTER IS AT " ;CHR$(129) ;Dump_device;CHR$ (128) 

GOTO Menu 

! 

Plotter: 1 

DISP " WHERE IS THE LOCATION OF THE PLOTTER"; 

LINPUT Temp$ 

IF Temp$-"" THEN GOTO 7620 
Plot device«VAL(Temp$) 

DISP " PLOTTER IS AT " ;CHR$ ( 129 ) ;Plot_device;CHR$ (128) 

GOTO Menu 

i ************************************************************************** 
j 

1 INITIALIZATION OF PARAMETERS 


I 


^642 1 
7643 !****' 
7650 Init: 
7660 1 
7670 
7680 
*690 
7700 
7710 I 
7720 
7730 1 
7740 
^750 1 
7760 
7770 I 
7780 
7790 ! 

7800 
^810 l 
7820 
7830 
7840 i 
7850 
7860 1 
(2870 
7880 I 
7890 
7900 l 


DEG 

GINIT 

GRAPHICS ON 

PLOTTER IS CRT, "INTERNAL" 

Dump_device-9 

Plot_device-705 

READ Skitter (*) 

MAT Skitrood- Skitter 

MAT Femurtemp- (1) 

MAT Tibiatemp- (1) 

MAT Trans- IDN 

MAT Tempa- (1) 

MAT Total- IDN 

Menu$-"MAIN" 


7910 
7920 1 

Twirl$- "ROTATE Y 

^930 
^940 I 

Freeleg$-"FIXED" 

7950 
7960 I 

Way-1 

7970 
7980 1 

Printflag$-"OFF" 

J990 
^000 l 

Increment-5 

8010 
8020 ! 

Rot_incroment»3 

8030 

Screen_x-1 

8040 
J050 1 

Screen_y-2 

*060 

Sys_trans_x-0 

8070 

Sys_trans_y»0 

8080 

Sys trans_z-0 

8090 

Sys_rot_x_-0 

8100 

Sys_rot_y-0 

J110 
*120 ! 

Sys_rot_z=0 

8130 

Fem_a_ang-0 

8140 

Fem_b_ang=0 

8150 

Fem_c_ang=0 

8160 

Tiba_ang=90 

J170 

Tib_b_ang=90 

*180 
8190 ! 

Tib_c_ang-90 

8200 

Pivot_ang_a=0 

8210 

p i vo t_a ng_b- 0 

8220 

pivot_ang_c=0 


! 

1 

i 

l 

! 


I 


1 


l 


l 

1 TRANS 

1 

l 

i 


! 


INITIALIZE SCREEN, SKITTER 

i 

SET TO DEGREES 
INITIATE GRAPHICS 
TURN G-PLANE ON 
INIT PLOTTER 


READ SKITTER DATA 


INIT TRANS MATRIX TO IDN 

INIT MAIN MENU 

AXIS OF TRANS X-l,Y-2,Z-3 
INC. 

INIT VIEW PLANE 
X— 1, Y— 2 , Z— 3 

INIT POSITONS OF SYSTEM 


INIT LEG ANGLES 


#9230 
8240 
8250 
8260 
8270 
8280 
#1290 
8300 
8310 
8320 
8330 
8340 
#1350 

8351 

8352 

8353 
8360 


Scr«enx_win_max-40 ! SET WINDOW 

Screenx_win_min— 2 o 
Screeny_win_max-4 0 

Screeny win_min— 20 . , 

SHOW Screenx_win_min , Screenx_win_max , Screeny_vin_min , Screeny_win_max 

! 

RETURN 

I A ************************************************************************ 1 

l 

J ******************** A **************************************************** 1 

I EXIT ROUTINE TO CLEAR SCREEN AND ENTER BASIC ENVIROMENT 

1 

J 

Finished: 


**************** 
! DONE WITH PROGRAM 


8370 

GCLEAR 

#380 

GRAPHICS OFF 

8390 

CLEAR SCREEN 

8400 

END 

8410 1 


8411 ! 


8412 ! 


! 


8414 l 


8415 ! 


8416 1 


8417 1 


8420 1 



« 


430 
440 

8441 

8442 

8443 

8444 
^450 
"t_y 

8460 
8470 
8480 
8490 
500 
510 


l************************************************************************ 


ROTATES SYTEM ABOUT LOCAL Y AXIS 


l 

! SUBROUTINE ROTATE: 

| ************************************************************************* 

SUB Rotate_y (Skitter (*) ,Skitmod(*) ,Total(*) ,Trans(*) ,Temp(*) ,Te*pa(*) ,Sys_r 
, Theta , Printf lag$) 

! 

DIM Bogus (4, 4) 

1 

Sys rot_y=Sys_rot_y+Theta 
IF Printflag$-"ON" THEN 

DISP " MODE: ROTATE Y BY ANGLE OF ", Theta," TOTAL ANGLE-" , Sys_rot_ 


y 

8520 

8530 

8540 

J550 

%560 

8570 

8580 

8590 

8600 

J610 

^620 

8630 

8640 

8650 

8660 


END IF 

MAT Tempa (*, 1: 3) = Skitter (*, 1: 3) 
! 

! SET UP ROTATION MATRIX 
1 

MAT Trans- IDN 
Sine-SIN (Theta) 

Cosine-COS (Theta) 

Trans (1,1) -Cosine 
Trans (1,3) -Sine 
Trans (3,1) —Sine 
Trans (3, 3) -Cosine 
j 

! INCREMENT Y ROTATION VARIABLE 
! 


*8680 MAT Bogus- Trans*Total 

8690 MAT Total- Bogus 

8700 MAT Tamp- Tempa*Total 

8710 MAT Skitmod (*,1:3)- Temp(*,l:3) 

8720 l 

^730 SUBEND 

8750 ! ************************************************************************** 
8761 1 SUBROUTINE ROTATE X: ROTATES SYSTEM ABOUT LOCAL X AXIS 

^764 1 

8770 SUB Rotate_x(Skitter(*) ,Skitmod(*) ,Total(*) ,Trans(*) ,Temp(*) ,Tempa(*) ,Sys_r 
ot_x, Theta, Print flag$) 

8780 OPTION BASE 1 
8790 DIM Bogus (4, 4) 

£800 i 

TJ810 sys rot x— Sys_rot_x+Theta 

8820 IF Print flaq$* M 0N w THEN 

3830 DISP " MODE: ROTATE X BY ANGLE OF ", Theta," TOTAL ANGLE-" , Sys_rot_ 

X 

8840 END IF 

£850 MAT Tempa (*,1:3)- Skitter(*,l:3) 

T3860 1 SET UP ROTATION MATRIX 
8870 1 

8880 MAT Trans- IDN 

8890 Sine-S IN (Theta) 

8900 Cos ine-COS (Theta) 

£910 Trans (2, 2) -Cosine 

%920 Trans (3, 3) -Cosine 

8930 Trans (2, 3)— Sine 

8940 Trans(3,2)-Sine 

8950 t 

8960 1 INCREMENT ROATATION VARIABLE 

£970 1 _ , 

%980 MAT Bogus- Trans*Total 

8990 MAT Total- Bogus 

9000 MAT Temp- Tempa*Total 

9010 MAT Skitmod (*,1:3)- Temp(*,l:3) 

9020 ! 

9030 SUBEND 

^040 ! ^^.. ...... . **************************************************** 

9050 J*^**************^*^ ************* 

9061 ! SUBROUTINE ROTATE Z: ROTATES SYSTEM ABOUT IX)CAL Z AXIS 

9063 i ************************************************************************* 

9070 SUB Rotate_z (Skitter ( * ) ,Skitmod(*) ,Total(*) ,Trans(*) ,Temp(*) ,Tempa(*) ,Sys_r 
ot_z , Theta , Pr intf lag$ ) 

9080 OPTION BASE 1 
9090 DIM Bogus (4, 4) 

9100 Sys rot_z=Sys_rot_z+Theta 

fcllO IF Print flag$="ON" THEN 

.-320 DISP " MODE: ROTATE Z BY ANGLE OF ", Theta," TOTAL ANGLE=" , Sys_rot_ 

z 

9130 END IF 

9140 MAT Tempa ( * , 1 : 3 ) = Skitter(*,l:3) 


>150 1 

>160 ! SET UP ROTATION MATRIX 
>170 I 

>180 MAT Trans- IDN 

>190 Sine-S IN (Theta) 

>200 Cos ine-COS (Theta) 

>210 Trans ( 1, 1) -Cosine 

>220 Trans (1,2) "-Sine 

>230 Trans (2, 1)-Sine 

>240 Trans (2, 2) "Cosine 

>250 ! 

'260 1 INCREMENT COUNTER? FIND NEW SKITTER MATRIX 

>270 MAT Bogus- Trans*Total 

>280 MAT Total- Bogus 

>290 MAT Temp- Tempa*Total 

>300 MAT Skitmod(*,l:3)- Temp(*,l:3) 

>310 SUBEND 

>320 1 

>330 1 ************************************************************************* 
>340 ! 

>341 1 SUBROUTINE TRANSLATE 3D: TRANSLATES SYSTEM ALONG A LOCAL X-Y-Z AXIS 
>342 1 

>343 1 ************************************************************************* 
>344 1 

>350 SUB Translate_3d (Skitter (*) ,Skitmod(*) ,Total(*) ,Temp(*) ,Tempa(*) ,Trans(*) ,S 
rs_trans_x , Sys_trans_y , Sys_trans_z , Way , Theta , Printf lag$) 

>360 OPTION BASE 1 
>370 DIM Laurie (4, 4) 

>380 ! 

>390 ! SET UP TEMP ARRAY SO AS NOT TO LOOSE PENS — SKITTER (*, 4 ) 

>400 ! 

>410 MAT Tempa(*, 1:3)- Skitter (*,1:3) 

>420 1 

>430 1 DETERMINE DIRECTION OF TRANSLATION AND SET UP TRANS MATRIX 
>440 ! 

>450 IF Way-1 THEN 

>460 Sys_trans_x-Sys_trans_x+Theta 

•470 Tx-Theta 

i480 Ty-0 

•490 Tz-0 

•500 IF Print flag$-"ON" THEN 

•510 DISP " MODE: TRANSLATE X BY ", Theta, "IN. TOTAL TRANSLATION-" , Sys t 

•ans_x " 

•520 END IF 

•530 END IF 

•540 IF way-2 THEN 

•550 Sys_trans_y=Sys_trans_y+Theta 

•560 Tx-0 

•570 Ty-Theta 

■580 Tz=0 

■590 IF Printflag$="ON" THEN 

600 DISP " MODE: TRANSLATE Y BY ", Theta, "IN. TOTAL TRANSLATION—" , Sys t 

•ans_y ~ 

610 END IF 

620 END IF 

630 IF way-3 THEN 

640 Sys_trans_z=Sys_trans_z+Theta 

650 Tx-0 

660 Ty-0 

670 Tz=Theta 


>680 IF Printflag$-"ON" THEN 

)690 DISP " MODE: TRANSLATE Z BY " ;Theta, "IN. TOTAL TRNASIATION-" ?Sys_t 

:ans_z 

>700 END IF 

>710 END IF 

>720 MAT Trans- IDN 

>730 Trans(4,l)-Tx 

>740 Trans(4,2)-Ty 

>750 Trans(4,3)-Tz 

>760 ! 

>770 i FIND NEW SKITTER MATRIX WITH CORRECT PENS 
>780 ! 

>790 MAT Laurie- Trans*Total 

>800 MAT Total- Laurie 

>810 MAT Temp- Tempa*Total 

>820 MAT SJcitmod ( * , 1 : 3 ) - Temp(*,l:3) 

>830 SUBEND 

>840 ! 

1850 1 ************************************************************************ 
I860 1 

>870 SUB Scaling_3d(Sx, Sy,Sz, Array (*)) 

>880 MAT Array- IDN 

>890 Array(l,l)“Sx 

>900 Array (2, 2) -Sy 

>910 Array (3, 3) -Sz 

>920 SUBEND 

>930 1 

>940 J*********************************************************************** 
>950 1 

>951 1 SUBROUTINE DISPLAY_SKIT: PLOTS SKITTER TO LOCAL PLOTTING DEVICE 

l952 ! OR SCREEN 

>954 {*********♦************************************************************* 
>955 1 

>960 SUB Display_skit (Skitter (*) ,Newskit(*) ,Screen_x,Screen_y) 

>970 OPTION BASE 1 

•980 DATA 1,1,4 l PEN1 

•990 DATA 4,4,4 1 PEN 2 

.0000 DATA 8,8,4 ! PEN 3 

0010 DIM Penl(l, 3) ,Pen2 (1,3) ,Pen3 (1, 3) , Temp (1,3) 

0020 READ Penl (*) , Pen2 (*) , Pen3 (*) 

0030 IF Screen_xol AND Screen_y<>2 THEN 

0040 MAT Tesp- Pen2 

0050 MAT Pen 2- Pen3 

0060 MAT Pen 3- Temp 

0070 END IF 

0080 MAT Nevskit (*,1)“ Skitter (*,Screen_x) 

0090 MAT Nevskit ( * , 2 ) - Skitter (*,Screen_y) 

0100 MAT Nevskit(*,3)- Skitter (*, 4) 

0110 MAT Nevskit (37: 37,*)- Penl 

0120 MAT Nevskit (68: 68,*)“ Pen2 

0130 MAT Nevskit (99: 99, *)“ Pen3 

0140 CLEAR SCREEN 

0150 GCLEAR 

0160 FRAME 

0170 IF Screen_x<>3 AND Screen_y<>2 THEN GOTO 10300 

0180 MOVE -100, -.9 

0190 RECTANGLE 200,. 15 

0200 MOVE -100, -.75 

0210 RECTANGLE 200,. 15 


MOVE -100, -.6 
RECTANGLE 200,. 15 
MOVE -100, -.45 
RECTANGLE 2 00,. 15 
MOVE -100, -.3 
RECTANGLE 200,. 15 
MOVE -100, -.15 
RECTANGLE 2 00,. 15 
PLOT Newskit(*) 
LINE TYPE 1 
SUBEND 


i 0340! 

0350! ********************************************************************* 
10360! 

10370 SUB Printmat (Array (*) ) 

10380 OPTION BASE 1 

10390 FOR ROW-BASE (Array, 1) TO SIZE (Array, 1J+BASE (Array, 1) -1 

10400 FOR Column-BASE (Array , 2 ) TO SIZE(Array, 2) +BASE (Array , 2) -1 

10410 PRINT USING "DDDD.DD,XX, #"; Array (Row, Column) 

10420 NEXT Column 

10430 PRINT 

10440 NEXT Row 

10450 SUBEND 

10460 ! 

10470 1********************************************************************** 
10480 ! 

10481 ! SUBROUTINE TRANS_TO_VECTOR: TRANSLATES SYSTEM TO A GIVEN POINT 
10482 ! 

10483 l********************************************************************** 
10490 SUB Trans_to_vector (Skitter (*) ,Skitmod(*) ,Temp(*) ,Tempa(*) ,Total(*) ,Trans( 
W) , sys_trans_x , Sys_trans_y , Sys_trans_z ) 

10500 ! 

10510 OPTION BASE 1 
10520 DIM Bogus (4,4) 

10530 ! SET UP STORAGE ARRAY TO KEEP SKITTER PENS CORRECT SKITTER (*, 4) 

10540 1 

10550 MAT Tempa(*, 1: 3)- Skitter(*, 1:3) 

10560 MAT Trans- IDN 

10570 ! 

10580 ! SET UP TRANS MATRIX 
10590 ! 

10600 Trans (4,1) »Sys_trans_x 

10610 Trans (4,2) -Sy s_trans_y 

10620 Trans(4,3)«Sys_trans_z 


10600 Trans (4,1) »Sys_trans_x 

10610 Trans (4,2) -Sy s_trans_y 

10620 Trans(4,3)-Sys_trans_z 

10630 ! 

10640 ! FIND NEW MATRIX 
10650 ! 

10660 MAT Bogus- Trans*Total 

L0670 MAT Total- Bogus 

10680 MAT Temp- Tempa*Total 

10690 MAT Skitmod(*, 1: 3) = Temp(*,l:3) 

10700 SUBEND 

10710 ! 

L0720 ! 

10730 ! *********************************************************************** 

10740 ! 

10741 ! SUBROUTINE VECTOR: TRANSLATES SYSTEM TO INPUT POINT 

[0742 • 

L0743 ! ************************************************************************ 


■10744 ! 

x0750 SUB Vector ( Skitter ( * ) ,Skitmod(*) ,Temp(*) ,Tempa(*) , Total (*) , Trans (*) ,Sys_tr 
an»_x, Sys_trans_y , Sys_trans_z , Newski t ( * ) , Screen_x , Screen_y , Pr inf lag$) 

10760 1 

10770 I ASK FOR INPUT <CR> MEANS LEAVE 
10780 1 
U0790 Ask: 1 

*0800 DISP " X COORDINANT RELATIVE TO " , Sys_trans_x 7 
10810 LINPUT Temp$ 

10820 IF Temp$-«" THEN 
10830 GOTO Leave 

10840 ELSE 

^0850 X-VAL(Temp$) 

*0860 END IF 


10870 DISP " Y COORDINANT RELATIVE TO " ,Sys_trans_y; 
10880 LINPUT Temp$ 

10890 IF Temp$“"" THEN 
10900 GOTO Leave 

J.0910 ELSE 

9.0920 Y«VAL(Temp$) 

10930 END IF 


10940 DISP " Z COORDINANT RELATIVE TO " ,Sys_trans_z ; 

10950 LINPUT Temp$ 

10960 IF Temp$-"" THEN 
10970 GOTO Leave 

^0980 ELSE 
10*90 Z-VAL(Temp$) 

HoOO END IF 
11010 ! 

11020! UPDATE TRANSLATION COUNTERS 
11030! 

1.1040 Sys_trans_x-Sys_trans_x+X 
11050 Sys_trans_y=Sys_trans_y+Y 
11060 Sys_trans_z-Sys_trans_z+Z 
11070! 

11080! FIND NEW SKITTER MATRIX 
11090! 

iLllOO CALL Trans to vector (Skitter (*) ,Skitmod(*) ,Temp(*) ,Tempa(*) , Total (*) , Trans 


(*),X,Y,Z) 

111101 

11120! DISPLAY SKITTER 

11130 CALL Display_skit(Skitmod(*) ,Newskit(*) ,Screen_x,Screen_y) 

11140 GOTO Ask 
fc.1150 Leave: ! 

11160 SUBEND 
11170 ! 

11180 ! 

11190 ! ************************************************************************* 
11200 ! 

1.1201 ! SUBROUTINE WINDOWS: ALLOWS USER TO CHANGE VIEWING AXIS 
11202 ! 

11203 1 ************************************************************************* 

11204 ! 

11210 SUB Windows (Skitmod (*) ,Newskit(*) ,Screen_x,Screen_y) 

11220 IF Screen_x=l AND Screen_y=2 THEN 

ll230 DISP " CURRENT WINDOW « X-Y PLANE" 

11240 END IF 

11250 IF Screen_x=*l AND Screen_y=3 THEN 

11260 DISP " CURRENT WINDOW - X-Z PLANE" 

11270 END IF 


.1280 

.1290 

.1300 

.1310 Menu: 

.1320 

.1330 

.1340 

.1350 

.1360 

.1370 

.1380 Zy_plane: 

.1390 

.1400 

.1410 

1420 


IF Screen_x-3 AND Screen_y-2 THEN 

DISP " CURRENT WINDOW - Z-Y PLANE" 

END IF 

l 

ON KEY 0 LABEL "X AXIS" GOTO Zy_plane 

ON KEY 2 LABEL "Y AXIS" GOTO Xz_plane 

ON KEY 4 LABEL "Z AXIS" GOTO Xy_plane 

ON KEY 9 LABEL "QUIT" GOTO Leave 

GOTO 11360 

l 

1 

Screen_x«3 

Screen_y-2 

DISP " NEW WINDOW - LOOKING DOWN X AXIS" 

CALL Display_skit(Skitmod(*) ,Newskit(*) ,Screen_x,Screen_y 


.1430 

1440 

1450 

1460 

1470 

1480 

1490 


l 

Xz_plane: 


GOTO Menu 
i 

Screen_x-1 

Screen_y-3 

DISP " NEW WINDOW - LOOKING DOWN Y AXIS" 

CALL Display_skit (Skitmod(*) ,Newskit(*) ,Screen_x,Screen_y 


1500 

1510 

1520 Xy_plane: 

1530 

1540 

1550 

1560 


GOTO Menu 
l 

l 

Screen_x»l 
Screen y *2 

DISP " _ NEW WINDOW - LOOKING DOWN Z AXIS" 

CALL Display_skit (Skitmod(*) ,Newskit(*) , Screen x, Screen_y 


1570 

1580 Leave: 

1590 
16001 
1610! 

1620! 

1640! 

1641 ! SUBROUTINE WINDOW_LIMITS : ALLOWS THE USER TO INPUT NEW VIEWING WINDOW 

1642 1 

j************************************************************************ 

1644 ! 

1650 SUB Window_l imit s ( Ski tmod ( * ) ,Newskit(*) ,Screen_x,Screen_y,Screenx_win_min, 
creenx_win_max , Screeny_win_min , Screeny_win_max) 

1660! 

1670! 

1680! 

1690 DISP " INPUT XMIN CURRENT VALUE IS",Screenx_win_min, " <CR> TO EXIT"; 

1700 LINPUT Temp$ 

1710 IF Temp$=" " THEN GOTO Leave 

1720 DISP " INPUT XMAX CURRENT VALUE IS",Screenx_win_max, " <CR> TO EXIT"; 

1730 LINPUT Templ$ 

1740 IF Templ$="" THEN GOTO Leave 
1750 IF VAL(Temp$) >VAL(Templ$) THEN 
1760 BEEP 1464.84,-5 

1770 DISP " XMIN HAS TO BE LESS THAN XMAX" 

1780 WAIT 3 

1790 GOTO 11690 


GOTO Menu 
! 

SUBEND 


1800 ELSE 

1810 Screenx vin_min-VAL(Temp$) 

1820 Screenx - vinjnax-VAL(Te:npl$) 

1830 END IF 
1840! 

1850! 

1860! 

1870 DISP " INPUT YMIN CURRENT VALUE IS" , Screeny_win_min, ” <CR> TO EXIT"; 

1880 LINPUT Temp? 

1890 IF Temp$-"" THEN GOTO Leave 

1900 DISP " INPUT YMAX CURRENT VALUE IS" , Screeny_win_max, " <CR> TO EXIT"; 

1910 LINPUT Templ$ 

1920 IF Templ$«"" THEN GOTO Leave 
1930 IF VAL(Terap$)>VAL(Templ$) THEN 
1940 BEEP 1464.84, .5 

1950 DISP " Y MIN MUST BE LESS THAN Y MAX" 

1960 WAIT 3 

1970 GOTO 11870 

1980 ELSE 

1990 Scree ny_w i n_m i n- VAL ( Temp $ ) 

2000 Screeny_win_max-VAL (Tempi $) 

2010 END IF 
2020! 

2030! 

2040 SHOW Screenx_win .iin, Screenx_win_max, Screeny_wln_min / Screeny_win_max 
2050 CALL Display_skit(Skitmod(*) ,Newskit(*) ,Screen_x7screen_y) 

2060! 

2070 Leave: ! 

2080 SUBEND 

2090! 

2100 1 ************************************************* *********** ****** ****** 
2110! 

2111 ! SUBROUTINE ANGLE: ALLOWS TE USER TO ROTATE SYSTEM BY INPUT ANGLE 

2112 1 ABOUT LAST ROTATION AXIS 

2113 ! 

2 H4 | *********************************************************************** 

2115 ! 

2120 SUB A igle (Skitter ( *) ,Skitmod(*) ,Temp(*) ,Tempa(*) ,Total(*) ,Trans(*) ,Sys_rot 
c, Sys_rot_y , Sys_rot_z , Newskit ( * ) , Screen_x, Screen_y , Printf lag$ , Twirl$) 

>130! 

>140! FIND MODE AND ROTATE ABOUT CORRECT AXIS 
>150! 

2160 IF Twirl $="ROTATE X" THEN 

2170 DISP " INPUT ANGLE TO ROTATE ABOUT X AXIS — CURRENT ANG=»" , Sys_rot_X ; 

2180 LINPUT Temp$ 

2190 IF Temp$="" THEN GOTO Leave 
2200 Theta=VAL(Temp$) 

>210 CALL Rotate_x (Skitter (*) ,Skitmod(*) ,Total(*) ,Trans(*) ,Tenip(*) ,Tempa(*) ,Sy 
rot_x, Theta, Print flag$) 

1220 END IF 
>230! 

•240! 

•250 IF Twirl$="ROTATE Y" THEN 

•260 DISP " INPUT ANGLE TO ROTATE ABOUT Y AXIS — CURRENT ANG=",Sys_rot_y; 

1270 LINPUT Temp$ 

:280 IF Temp$="" THEN GOTO Leave 
:290 Theta=VAL ( Temp$ ) 

:300 CALL Rotate y (Skitter (*) ,Skitmod(*) , Total (*) , Trans (*) ,Temp(*) ,Tempa(*) ,Sy 
rot_y, Theta, Printf lag$) 

310 END IF 


ONTINUEC 


03.2320! 

12330! 

12340 IF Twirl$-"R0TATE Z" THEN 

12350 DISP " INPUT ANGLE TO ROTATE ABOUT Z AXIS — CURRENT ANG"" , Sye_rot_Z J 
12360 LINPUT Temp$ 

12370 IF Temp$«"" THEN GOTO Leave 


^.2380 Thcta-VAL (Temp$ ) 

*2390 CALL Rotate_z (Skitter (*) ,Skitmod(*) ,Total(*) ,Trans(*) ,Temp(*) ,Tempa(*) ,Sys 
rot_z, Theta, Print flag$) 

12400 END IF 
12410 ! 

12420 ! OUTPUT NEW PICTURE 

^2430 ! 

*2440 CALL Display_skit (Skitmod(*) ,Newskit(*) , Screen x,Screen_y) 

12450 GOTO 12150 
12460 ! 

12470 ! 

12480 Leave: 1 
J.2490 SUBEND 

*2500 l 

12510 l*************************** *************** ****************************** 

12511 ! 

12512 ! SUBROUTINE WHAT: OUTPUTS PROGRAM VARIABLES TO SCREEN 

12513 ! 

J.2514 ! ************************************************************************ 
*2520 l 

12530 SUB What(Sys trans_x,Sys_trans_y ,Sys_trans_z,Sys_rot_x,Sys_rot_y,Sys_rot_z 
, A,B,C,D,Printflag$ ,Screenx,Screeny,Plotd,Dumpd,Fa,Fb,Fc,Ta,Tb,Tc,Inc,Sp,Tp,Up) 
12540 ! 

12550 GRAPHICS OFF 
^L2560 CLEAR SCREEN 

*2570 PRINT CHR$ ( 132 )? "THESE ARE THE CURRENT PARAMETERS: "?CHR$( 12 8) 

12580 PRINT 

12590 PRINT CHR$ (129) } " WINDOW: ”;CHR$(128) X MIN - ";A;" X MAX - 

";b 

12600 PRINT " Y MIN - ";C;" Y MAX - ";D 

J.2610 PRINT 

*2620 IF Screenx-1 AND Screeny-2 THEN PRINT CHR$(129);« VIEW: " ;CHR$ (128) LOOK 
ING DOWN Z AXIS" 

12630 IF Screenx-3 AND Screeny=2 THEN PRINT CHR$(129);" VIEW: ";CHR$(128) ;" LOOK 
ING DOWN X AXIS" 

12640 IF Screenx=l AND Screeny-3 THEN PRINT CHR$(129)j" VIEW: ";CHR$(128) ;" LOOK 
ING DOWN Y AXIS" 

*2650 PRINT 

12660 PRINT "PLOTTER LOACTION: " ;CHR$ (129) ;Plotd;CHR$ (128) ;" PRINTER LOCATIO 

N:";CHR$ (129) ; Dumpd ; CHR$ (128) 

12670 PRINT 

12680 IF Printflag$-"ON" THEN 

12690 PRINT " DISPLAY VALUES IS " ;CHR$ (129) ; " ON ";CHR$(128) 

0L27CO E LS E 

1271C PRINT " DISPLAY VALUES IS OFF" 

1272 J END IF 
12730 PRINT 

12740 PRINT TAB (5) ;CHR$(132) ; "TRANS (in.) ROT (deg) " ;CHR$ (128) ; " 

" ; CHR$ (132) ; " FEMUR ANGLE TIBIA ANGLE" ;CHR$ (128) 

%2750 PRINT 

12760 Brice: IMAGE AA, 2X, 4D. 2D, 6X, 4D. 2D, 18X, A, 6X, 4D. 2D, 8X, 4D. 2D 

12770 PRINT USING Brice;"X " ;Sys_trans_x;Sys_rot_x;"A";Fa;Ta 
12780 PRINT USING Brice;"Y " ;Sys_trans_y;Sys_rot_y;"B";Fb;Tb 
12790 PRINT USING Brice ;"Z " ;Sys_trans_z ;Sys_rot_z; "C" ;Fc;Tc 


PRINTER LOCATIO 


*12810 PRINT "PIVOT ANG A:">Sp/" PIVOT ANG B:";Tp;" PIVOT ANG C:";Up 
12820 INPUT "HIT <CR> TO CONTINUE" ,Temp$ 

12830 CLEAR SCREEN 
12840 ALPHA OFF 
12850 GRAPHICS ON 
fl2860 SUBEND 

l2870 1 ^^w**************************************** 

12880 l**************************** 

12891 ! SUBROUTINE ROTATE LEG Z! ROTATES ENTIRE LEG ABOUT Z AXIS 

12892 I S.J.+++++++++++++******************************** 

^12893 l***************************"*" 

12900 SUB Rotate_leg_z(Femur(*),Femurmod(*),Leg$,Theta,Printflag$, OPTIONAL Femur 

a_rot , Way) 

12920 DIM Bogus(4,4) ,Temp(196,4) , Tampa (196, 4) ,Trans(4,4) 

J.2930 N«SIZE( Femur, 1) 

^2940 
129501 

12960 IF Way-1 THEN 

12970 Femura_rot-Femura_rot+Theta 

129801 

1,2990 IF Printflag$-"ON" THEN 

•[3OOO 
•mura_rot 
13010 END IF 

13020 END IF 

130301 

j. 3040 MAT Tempa- (1) 

^3050 
130601 

130701 SET UP ROTATION MATRIX 
130801 

MAT Trans- IDN 
Sine-SIN (Theta) 

Cosine-COS (Theta) 

Trans (1,1) -Cosine 
Trans (1,2)— Sine 

Trans (2,1) -Sine 
Trans (2, 2) -Cosine 


REDIM Tempa(N,4) ,Temp(N,4) 


DISp t " 1 MODE:"?Leg$;" THROUGH ANGLE OF ";Thetaj" TOTAL ANGLE-", F 


PlAi Itsmpa- 

MAT Tempa (*,1:3)- Feraur(*,l:3) 


13090 

J3100 

*3110 

13120 

13130 

13140 

13150 

J.31601 

*31701 

131801 

13190 

13200 

13210 


FIND NEW SKITTER MATRIX 


MAT Temp- Tempa "Trans 
MAT Femurmod(*,l:3)- Temp(*,l:3) 

13210 SUBEND 

<} 3230 ! *********************************************************************** 
13241 S SUBROUTINE TRANS FEM ORIG: TRANSLATES LEG TO ORIGIN 

13243 !********************************************************************** 

13244 ! 

41.3250 SUB Trans_fem_orig (Femur (*) ,Femurmod(*) ,X,Y,Z) 

13260 l 

13280 DI^BogusH,^) , Tempa ( 196 , 4) , Temp (196, 4) , Trans (4, 4) 

13290 N— SIZE (Femur , 1) 


013300 REDIM Tempa(N,4) ,Teap(N,4) 

13320 ! SET UP STORAGE ARRAY TO KEEP SKITTER PENS CORRECT SKITTER (*, 4) 


13330 ! 

13340 MAT Teapa- (1) _ _ , 

13350 MAT Teapa(*,l:3)- Faaur(*,l:3) 

J.3360 MAT Trana- IDN 

a3370 1 

13380 1 SET UP TRANS MATRIX 
13390 1 

13400 Trans (4 , 1)-X 

13410 Trans(4,2)-Y 

•13420 Trans(4,3)-Z 

*13430 1 

13440 I FIND NEW MATRIX 


13400 

13410 

1^3420 


13450 1 

13460 

13470 


MAT Temp- Teapa*Trans 

MAT Femurmod (*,1:3)- Temp (*,1:3) 


L3480 SUBEND 
L3490 ! 


13500 l****************************** w "" w *”" ww 

J 35 II j SUBROUTINE ROTATE LEG Y: ROTATES LEG ABOUT Y AXIS 

13513 !*********************************************************************** 
®i3514 l 

13520 SUB Rotate_leg_y (Femur(*) ,Femurmod(*) , Theta) 

13530! 

13540 OPTION BASE 1 ,, 

13550 DIM Bogus(4,4) , Temp (196, 4) ,Tempa (196, 4) ,Trans(4,4) 

13560 N-SIZE ( Femur, 1) 

n3570 REDIM Tempa(N,4) ,Temp(N,4) 

13580! 

13590 MAT Tempa- (l) , 

13600 MAT Tempa(*,l:3)- Femur (*,1:3) 

13610! 

13620! SET UP ROTATION MATRIX 
*13630! 

13640 MAT Trans- IDN 

13650 Sine-SIN (Theta) 

13660 Cosine-COS (Theta) 

13670 Trans (1,1) -Cosine 

13680 Trans (1,3) -Sine 

*13690 Trans (3,1)— Sine 

13700 Trans (3,3) -Cosine 


13640 MAT Trans- IDN 

13650 Sine-SIN (Theta) 

13660 Cosine-COS (Theta) 

13670 Trans (1,1) -Cosine 

13680 Trans (1,3) -Sine 

*13690 Trans (3,1)— Sine 

13700 Trans (3,3) -Cosine 

137101 

137201 FIND NEW SKITTER MATRIX 
13730! 

13740 MAT Temp- Tempa*Trans 

*13750 MAT Femurmod (*, 1: 3)- Temp (*,1:3) 

13760 SUBEND 

13770! 

13790! ************************************************************************* 
13800 I 

^3801 ! SUBROUTINE ZOOM PAN: ALOOWS USER TO PAN OR ZOOM WINDOW 

13803 j *********************************************************************** 

HlVo SUB Zo 0 m_pan (Window$ , Xmin, Xmax, Ymin, Ymax, Skitmod(*) ,Newskit(*) ,Screen_x,Sc 


••• n _y) _ . 

13820 OH ERROR GOTO Brice 

138301 

13840 DISP " YOUR CURRENT WINDOW VALUES ARE XMIN : " ; Xmin ; " XMAX : " ; Xmax j " YM 

CN:"jY«in;" YMAX:"; Ymax 
13850 Menu: 1 

1.3880 ON KNOB .15 GOTO Knob_isr 

:3870 ON KEY 9 LABEL "QUIT" GOTO Leave 

.3880 ON KEY 0 LABEL "ZOOM" GOTO Zoom 

*3890 ON KEY 1 LABEL GOTO 13970 

.3900 ON KEY 2 LABEL "PAN X" GOTO Pan_x 

.3910 ON KEY 3 LABEL "" GOTO 13970 

.3920 ON KEY 4 LABEL "PAN Y" GOTO Pan_y 

.3930 ON KEY 5 LABEL "" GOTO 13970 

.3940 ON KEY 6 LABEL "INPUT DATA " GOTO Input_data 

[3950 ON KEY 7 LABEL "" GOTO 13970 

.3960 ON KEY 8 LABEL "" GOTO 13970 

.3970 GOTO 13970 

.3980 1 

.3990 Pan x: 1 

.4000 Window$-"PAN X" 

.4010 GOTO Menu 

.4020 Pan_y: l 

.4030 Window$«"PAN Y" 

.4040 GOTO Menu 

.4050 Zoom: 1 

.4060 Window$-"ZOOM" 

.4070 GOTO Menu 

.4080 Knob_isr: 1 
.4090! 

4100 Theta-KNOBX 

.4110 IF Windows-" ZOOM" AND Theta>0 THEN 

.4120 Xmin-Xrain-5 

.4130 Xmax-Xmax+5 

.4140 Ymin-Ymin-5 

.4150 Ymax-Ymax+5 

4160 SHOW Xmin , Xmax , Ymin , Ymax 

4170 END IF 

4180! 

4190! 

4200 IF Window$-"ZOOM" AND Theta<0 THEN 

4210 Xmin-Xmin+5 

4220 Xmax-Xmax-5 

4230 Ynin-Ymin+5 

4240 Ymax-Ymax-5 

4250 SHOW Xmin, Xmax, Ymin, Ymax 

4260 END IF 

•1270! 

4280 ! 

4290 IF Window$=" PAN X" AND Theta<0 THEN 

4300 Xmin-Xmin+5 

4310 Xmax=Xmax+5 

4320 SHOW Xmin, Xmax, Ymin, Ymax 

4330 END IF 

4340! 

4350! 

4360 IF Window$="PAN X" AND Theta>0 THEN 

4370 Xmin=Xmin-5 

4380 Xmax=Xmax-5 

J390 SHOW Xmin, Xmax, Ymin, Ymax 

L 



3.4400 

14410! 

14420! 

14430 

14440 

14450 

J.4460 

14470 

14480! 

14490! 

14500 

14510 

14520 

14530 

14540 

14550! 

14560 

14570 

L4580 ! 

14590 1 


END IF 


IF Windov$-"PAN Y" AND Theta>0 THEN 
Ymin-Yain+5 
Ymax-Ynax+5 

SHOW Xmin, Xmax, Ymin, Ymax 


END IF 


IF Window$«"PAN Y" AND Th8ta<0 THEN 
Ymin-Ymin-5 
Ymax- Ymax- 5 

SHOW Xmin, Xmax, Ymin, Ymax 


END IF 


CALL Display _akiw (Skitaod ( *) ,Nevskit<*) ,Screen_x,Screen_y) 
GOTO 13840 


14 600 Input 
L4610 
14620 
14630 
L4640 
14650 
14660 
14670 
L4680 
L4690 
L4700 
L4710 
L4720 
14730 
L4740 
L4750 
14760! 
14770! 
L47801 
14790 
14800 
L4810 
L4820 
L4830 
14840 
L4850 
14860 
14870 
.4880 
.4890 
.4900 
.4910 
.4920 
.4930 
.4940! 
.4950! 
.4960 
4970 
4980 
4990 


DISP*" INPUT XMIN CURRENT VALUE IS", Xmin," <CR> TO EXIT"; 

LINPUT Temp$ 

D^P C " P INPUT T XMAX G --- CURRENT VALUE IS", Xmax," <CR> TO EXIT"; 
LINPUT Templ$ 

IF Templ$«"" THEN GOTO Leave 
IF VAL(Temp$) >VAL(Templ$) THEN 
BEEP 1464. 84,. 5 

DISP " XMIN HAS TO BE LESS THAN XMAX 
WAIT 3 
GOTO 14610 
ELSE 

Xmin-VAL ( Temp$ ) 

Xmax-VAL ( Temp 1 $ ) 

END IF 


DISP » INPUT YMIN CURRENT VALUE IS", Ymin," <CR> TO EXIT" 

LINPUT Terop$ 

Jl S p e “ P INTOT T Y^X G ---- L CURRENT VALUE IS",Ymax," <CR> TO EXIT" 
LINPUT Templ$ 

IF Templ$-"" THEN GOTO Leave 
IF VAL(Temp$) >VAL(Templ$) THEN 
BEEP 1464 . 84 *5 

« y MIN MUST BE LESS THAN Y MAX 11 

WAIT 3 
GOTO 14790 
ELSE 

Ymin=VAL(Temp$) 

Ymax=VAL ( Temp 1 $ ) 

END IF 

^how Xmin . Xmax , Ymin , Ymax 

CALL Display_skit ( Skitmod ( * ) ,Newskit(*> ,Screen_x,Screen_y) 
GOTO Menu 


Brice: 1 

IP ERRN-31 THEN 
BEEP 1464 ,. 5 

DISP ■ THIS IS AS FAR AS YOU CAN GO 1 ! ! 1 1 ! Ill 1!! 1! ! Ill " 

WAIT 2 

Xmin-Xoin-5 

Xnax-Xan+5 

Ymin-Ymin-5 

Ymax-Ynax+5 

SHOW Xnin,Xroax,Ymin,Yinax 

CALL Display _skit (Skitmod ( *) ,Newskit(*) ,Screen_x,Screen_y) 

GOTO 13840 
END IF 

Leave : ! 

SUBEND 

1 ************************************************************************ 
i SUBROUTINE PLOT IT: SETS UP PLOTTER PARAMETERS FOR HARD COPY 

J ************************************************************************ 
1 

SUB Plot_it(Plot_device) 

DIM L$ [ 32 ] 

DISP " HOW MANY QUADRANTS 1,2 OR 4 DEFAULT- 1 " ; 

LINPUT Quad$ 

IF Quad$-"" THEN 
Quad-1 
i ELSE 

Quad-VAL ( Quad$ ) 

END IF 

IF Quad-1 THEN GOTO Label 
IF Quadol AND Quad<>2 AND Quad<>4 THEN 
BEEP 1464, .5 
GOTO 15190 
END IF 

DISP " WHICH SQUARE DEFAULT-1"; 

LINPUT What$ 

IF What$-"" THEN 
What-1 

£Lg£ 

What-VAL ( What $ ) 

END IF 

IF Whatol AND What<>2 AND What<>3 AND What<>4 THEN 
BEEP 1464, .5 
GOTO 15310 
D END IF 


Label : 1 

DISP " INPUT ANY LABELS DEFAULT- NONE"; 

LINPUT L$ 

IF L$— "" THEN GOTO PI 
Pi: 1 

PRINTER IS Plot_device 

IF ^^pJjJ^MjNjip.sPl.-SI . 5 , . 5 ; PA 425, 1000, LB";L$;CHR$(3) ;";SP0;" 

END IF 

IF Quad=4 THEN 

IF What=l THEN 

PRINT "IN;IP250, 596, 5250, 4196;SP1;SI;PA 425, 900 , LB" ;L$ ;CHR$ (3 ) ;";S 


I 


fO;" 




15560 


END IF 


15570 


IF What-2 THEN 


15580 


PRINT "IN; IP5250, 596, 10250, 4196;SP1 

;SI;PA 5425,900,LB : ';L$;CHR$(3) ; 

">SP0; 

If 



15590 


END IF 


■L5600 


IF What-3 THEN 


15610 


PRINT "IN;IP250, 4196, 5250, 7796;SP1; 

SI; PA 425 4500, LB" ; L$ ;CHR$(3) ;■ 

;SPO;" 




15620 


END IF 


15630 


IF What-4 THEN 


15640 


PRINT "IN;IP5250, 4196, 10250, 7796;SP1 

, SI, PA 5425, 4500,LB";L$;CHR$(3 

J ;";SP0;" 



*15650 


END IF 


15660 


END IF 


15670 

IF 

Quad-2 THEN 


15680 


IF What-2 THEN 


15690 


PRINT "IN;R090;IP;IW;IP154, 244, 7354, 5122;SP1;SI .35,.35;PA 600,6 

i)0;LB";L$;CHR$(3) ;";SPO;« 


15700 


ELSE 


15710 


PRINT N IN ;RO90; IP; IW;IP154, 5122, 7354, 10244 ;SP1; SI .35,.35;PA 600 

.5478; 

LB” ; L$ ; CHR$ ( 3 ) ; " ;SPO ; " 


15720 


END IF 


15730 

END IF 


J5740 

Leave ; i 


15750 


SUBEND 


15751 

I 



15752 

I 



15753 

i 



15754 

! 



J.5755 

!***< 



15756 

! 



15757 

! SUBROUTINE MOVIE: ALLOWS USER TO INPUT 

DATA FILES FOR ANIMATION 

15758 

! 

OF POSITION SEQUENCES 

15759 

1 



15760 

J ************************************************************************* 

J.5761 

1 



15763 

SUB Movie 


15770 

REM 

**************************************************************** 

15780 

DATA 

0,0,0,10 1 

UPPER BODY 

15790 

DATA 

6.5482,28.4912,0,-2 ! 

A 

15800 

DATA 

9.1602,20.9817,3.2283,-1 1 

H 

JL5810 

DATA 

-1.7468,20.9817,9.5688,-1 ! 

I 

15820 

DATA 

-3.2741,28.4912,5.6709,-1 ! 

B 

15830 

DATA 

O 

o 

o 


15840 

1 



15850 

DATA 

o 

o 

o 

M 

O 


15860 

DATA 

-3.2741,28.4912,5.6709,-2 ! 

B 

15870 

DATA 

-7.3759,20.9817,6.3188,-1 ! 

J 

15880 

DATA 

-7.3759,20.9817,-6.3188,-1 ! 

K 

15890 

DATA 

-3.2741,28.4912,-5.6709,-1 ! 

C 

15900 

DATA 

o 

O 

o 


15910 

i 



15920 

DATA 

o 

o 

o 

M 

O 


15930 

DATA 

-3.2741,28.4912,-5.6709,-2 ! 

C 

15940 

DATA 

-1.7468,20.9817,-9.5688,-1 ! 

L 

15950 

DATA 

9.1602,20.9817,-3.2283,-1 ! 

G 

15960 

DATA 

6.5482,28.4912,0,-1 ! 

A 

15970 

DATA 

0,0, 0,7 


15980 

1 





£1.5990 

DATA 

0,0,0,10 

i 

bottom body 

i6000 

DATA 

6.5482,13.4722,0,-2 

! 

D 

16010 

DATA 

9.1602,20.9817,3.2283,-1 

! 

H 

16020 

DATA 

-1.7468,20.9817,9.5688,-1 

1 

I 

16030 

DATA 

-3.2741,13.4722,5.6709,-1 

1 

E 

16040 

DATA 

r* 

o 

o 

* 

o 



^.6050 

l 




*6060 

DATA 

0,0,0,10 



16070 

DATA 

-3.2741,13.4722,5.6709,-2 

1 

E 

16080 

DATA 

-7.3759,20.9817,6.3188,-1 

I 

J 

16090 

DATA 

-7.3759,20.9817,-6.3188,-1 

! 

K 

16100 

DATA 

-3.2741,13.4722,-5.6709,-1 

1 

P 

^16110 

DATA 

0,0, 0,7 



*6120 

! 




16130 

DATA 

o 

•» 

O 

•» 

o 

* 

o 



16140 

DATA 

-3.2741,13.4722,-5.6709,-2 

1 

F 

16150 

DATA 

-1.7468,20.9817,-9.5688,-1 

I 

L 

16160 

DATA 

9.1602,20.9817,-3.2283,-1 

J 

G 

16170 

DATA 

6.5482,13.4722,0,-1 

1 

D 

*6180 

DATA 

0,0, 0,7 



16190 

l 




16200 

DATA 

0,0, 0,4 


1 RESERVED FOR PEN 

16210 

DATA 

0,0,0,10 

1 

FEMUR ONE 

16220 

DATA 

9.1602,20.9817,-3.2283,-2 

l 

G 

16230 

DATA 

29.6602,20.9817,-3.2283,-1 

! 

M 

*6240 

DATA 

18.7362,25.0731,0,-1 

! 

0 

16250 

DATA 

0,0, 0,7 



16260 

1 




16270 

! 




16280 

DATA 

o 

o 

o 

O 



16290 

DATA 

29.6602,20.9817,3.2283,-2 

1 

N 

•16300 

DATA 

18.7362,25.0731,0,-1 

1 

0 

16310 

DATA 

9.1602,20.9817,3.2283,-1 

! 

H 

16320 

DATA 

0,0, 0,7 



16330 

1 




16340 

DATA 

0,0,0,10 



16350 

DATA 

9.1602,20.9817,-3.2283,-2 

1 

G 

*6360 

DATA 

29.6602,20.9817,-3.2283,-1 

! 

M 

16370 

DATA 

20.571,16.8903,0,-1 

1 

P 

16380 

DATA 

0,0, 0,7 



16390 

i 

+ 




16400 

DATA 

o 

«H 

O 

* 

o 

* 

o 



16410 

DATA 

29.6602,20.9817,3.2283,-2 

1 

N 

*6420 

DATA 

20.571,16.8903,0,-1 

l 

P 

16430 

DATA 

9.1602,20.9817,3.2283,-1 

l 

H 

16440 

DATA 

0,0, 0,7 



16450 

1 




16460 

DATA 

o 

rl 

o 

o 

o 

1 

TIBIA ONE 

16470 

DATA 

29.6602,20.9817,-3.2283,-2 

1 

M 

*6480 

DATA 

30.4255,0,0,-1 

i 

A' 

16490 

DATA 

35.7901,9.2132,0,-1 

! 

B' 

16500 

DATA 

0,0, 0,7 



16510 

1 




16520 

DATA 

o 

o 

*8 

o 

M 

O 



16530 

DATA 

29.6602,20.9817,3.2283,-2 

! 

N 

*6540 

DATA 

30.4255,0,0,-1 

j 

A' 

16550 

DATA 

35.7901,9.2132,0,-1 

! 

B* 

16560 

DATA 

r* 

o 

* 

o 

o 



15570 

1 




16580 

DATA 

o 

o 

o 

! RESERVED FOR PEN 



4L6S90 

DATA 

o 

o 

% 

o 

H 

o 


16600 

DATA 

-1.7468,20.9817,9.5688,-2 ! 

I 

16610 

DATA 

-9.3493,25.0731,16.2368,-1 1 

S 

16620 

DATA 

-11.9968,20.9817,27.3223,-11 

Q 

16630 

DATA 

0,0, 0,7 


16640 

1 



^6650 

DATA 

0,0,0,10 


*6660 

DATA 

-17.6259,20.9817,24.0723,-21 

R 

16670 

DATA 

-9.3493,25.0731,16.2368,-1 1 

S 

16680 

DATA 

-7.3759,20.9817,6.3188,-1 ! 

J 

16690 

DATA 

r* 

o 

o 

O 


16700 

! 



^6710 

DATA 

o 

o 

* 

o 

<4 

O 


*6720 

DATA 

-1.7468,20.9817,9.5688,-2 1 

I 

16730 

DATA 

-10.2667,16.8903,17.8258,-11 

T 

16740 

DATA 

-11.9968,20.9817,27.3223,-11 

Q 

16750 

DATA 

0,0, 0,7 


16760 

l 



J6770 

DATA 

0,0,0,10 


*6780 

DATA 

-17.6259,20.9817,24.0723,-21 

R 

16790 

DATA 

-10.2667,16.8903,17.8258,-11 

T 

16800 

DATA 

-7.3759,20.9817,6.3188,-1 1 

J 

16810 

DATA 

* 

o 

o 

o 


16820 

i 



16830 

! 



46840 

DATA 

0,0,0,10 1 


16850 

DATA 

-11.9968,20.9817,27.3223,-2 1 

Q 

16860 

DATA 

-15.1940,0,26.3601,-1 1 

C* 

16870 

DATA 

-17.8763,9.2132,31.0059,-1 1 

D' 

16880 

DATA 

0,0, 0,7 


16890 

1 



46900 

DATA 

0,0,0,10 


16910 

DATA 

-17.6259,20.9817,24.0723,-2 l 

N 

16920 

DATA 

-15.1940,0,26.3601,-1 l 

C» 

16930 

DATA 

-17.8763,9.2132,31.0059,-1 

1 D' 

16940 

DATA 

r- 

•k 

o 

o 

o 


16950 

1 



4.6960 

DATA 

0,0, 0,4 ! RESERVED FOR PEN 

16970 

DATA 

0,0,0,10 ! 


16980 

DATA 

-7.3759,20.9817,-6.3188,-2 ! 

K 

16990 

DATA 

-9.3493,25.0731,-16.2368,-1! 

W 

17000 

DATA 

-17.6259,20.9817,-24.0723,-11 

U 

17010 

DATA 

0,0, 0,7 


4.7020 

! 



17030 

DATA 

0,0,0,10 


17040 

DATA 

-11.9968,20.9817,-27.3223,-2 1 

V 

17050 

DATA 

-9.3493,25.0731,-16.2368,-1 1 

w 

17060 

DATA 

-1.7468,20.9817,-9.5688,-1 1 

L 

17070 

DATA 

* 

o 

o 

K. 

o 


47080 

! 



17090 

DATA 

0,0,0,10 


17100 

DATA 

-7.3759,20.9817,-6.3188,-2 ! 

K 

17110 

DATA 

-10.2667,16.8903,-17.8258,-1 ! 

X 

17120 

DATA 

-17.6259,20.9817,-24.0723,-1 ! 

U 

17130 

DATA 

0,0, 0,7 


47140 

1 



17150 

i 



17160 

DATA 

0,0,0,10 


17170 

DATA 

-11.9968,20.9817,-27.3223,-2 ! 

V 

17180 

DATA 

-10.2667,16.8903,-17.8258,-1! 

X 


FEMUR TWO 


TIBIA TWO 


FEMUR THREE 



£1.7190 DATA 
17200 DATA 
17210 I 
17220 DATA 
17230 DATA 
17240 DATA 
^.7250 DATA 
i7260 DATA 
| 17270 I 
I 17280 DATA 
| 17290 DATA 
| 17300 DATA 
! J.7310 DATA 
[Ti7320 DATA 
17330 REM 
17340 1 
17350 ! 
17360 
| J-7370 
™ 7380 
17390 
17400 
17410 
17420 
.7430 


—1.7468, 20. 98 17, -9. 5588,-1 

0,0, 0,7 


1 


0 , 0 , 0,10 ^ , 
-17.6259,20.9817,-24.0723,-2 l 
-15.1940,0,-26.3601,-1 | 

-17.8763,9.2132,-31.0059,-1 I 

0,0, 0,7 


TIBIA THREE 


U 

E' 

F' 


0.0,0,10 

-11.9968,20.9817,-27.3223,-2 ! 

-15.1940,0,-26.3601,-1 J 

-17.8763,9.2132,-31.0059,-1 I 

2;2;2;I********************************************************* 


V 

E* 

F' 


I DEFINE VAR 


OPTION BASE 1 
REAL Fenur(31,4) , Femurrood ( 3 1 , 4 ) 

REAL Tibia (10, 4) , Tibiatemp (10,4) ,Tibiamod(l<M) 

INTEGER P.nl(l,3) ,P«"2(1,3) ,P«n3(l,3) ( IMITILIJA TION ROUTINE 

CALL B Display_sktt (Skitter (*J .NewskitC) 


IPEN1 

JPEN2 

IPEN3 


^7440 
17450 
17460! 

17470 DATA 1,1,4 
17480 DATA 4,4,4 
17490 DATA 8,8,4 
•.75001 

”ho msp^oo you want to run an already computed file 

17530 LINPUT Ans$ 

17550 ! 

17560 1 

%7561 1 INPUT DATA FILE 
17562 ! 

17570 
17580 
17590 
17600 
•7610 
17620 
17630 
17640 
17650 
17660 
•7670 
17680 ! 

17690 IF Ans$-"N" THEN 
17700 DISP "INPUT MOVIE FILE"; 

17710 LINPUT File$ 

17720 IF File$="" THEN 
#7730 GOTO 17700 

17740 ELSE 

17750 Skitwork$="SKITWORK 
17770 EN ° 1 CREATE BDAT Skitwork$ , 400 


Y OR N"; 


IF Ans$-"Y" THEN 

DISP "NAME OF COMPUTED FILE"; 
LINPUT Name$ 

IF Name$=»"" THEN 
GOTO 17520 

ELSE 

Skitwork$”Name $ 

File_flag-1 
GOTO Movie 
END IF 
END IF 



£17780 ASSIGN §Pathl TO Skitwork$ 

17790 ASSIGN ®Path2 TO File$ 

17800 END IF 

17810! 

17820 READ Penl (*) , Pon2 (*) , Pen3 (*) 
17830! 


^.7840 Top:! 
"7850 


ENTER 8 Path2 ; Tim , Free , Fada t , Tada t , Fbdat , Tbdat , Fcda t , Tcdat , Xr , Yr , Z r , Tx 

Tv Tz 

i************************************************************************* 

17852 ! 

17853 1 DETERMINE TRANFORMATION MATRICES FOR EACH TIME UNIT 
JL7854 ! 

17855 1 ************************************************************************* 

17856 ! 

IF Tim-999 THEN GOTO Movie 
N-N+l 

IF Free-0 THEN Freeleg$-"FIXED" 

IF Free-1 OR Free-2 THEN FreelegS-TREE" 


17860 
17870 
17880 
^.7890 
"7900 1 
17910 
17920 
17930 
17940 
J.7960 
*7970 
17980 
17990 
18000 1 
18010 
3.8020 
*8030 
18040 ! 
18050 
18060 
18070 
18080 
%8090 
18100 ! 
18110 
18120 
18130 
18140 
%8150 
18160 
18170 
18180 
18190 ! 
18200 
%8210 
18220 
18230 ! 
18240 
18250 
18260 
*8270 
18280 
18290 ! 
18300 
18310 


IF FadatoO AND Fadat<>999 THEN 
Leg$-" FEMUR A" 

IF Free-2 THEN 

Leg_flag$-" FEMUR A” 

END IF 
Theta-Fadat 
GOSUB Leg_isr 
END IF 

IF Fadat-999 THEN 
Leg_flag$— "FEMUR A" 

END IF 

IF Tadatoo THEN 
Leg$-"TIBIA A" 

Theta-Tadat 
GOSUB Leg_isr 
END IF 

IF FbdatoO AND Fbdat<>999 THEN 
Leg$-" FEMUR B" 

IF Free-2 THEN 

Leg_flag$=‘" FEMUR B" 

END IF 
Theta-Fbdat 
GOSUB Leg_isr 
END IF 

IF Fbdat-999 THEN 

Leg_flag$-"FEMUR B" 

END IF 

IF TbdatoO THEN 
Leg$-"TIBIA B" 

Theta-Tbdat 
GOSUB Leg_isr 
END IF 

IF FcdatoO AND Fcdat<>999 THEN 
Leg$=" FEMUR C" 



18320 

IF Free-2 THEN 

18330 

Lag flag$-"FEMUR c" 

18340 

END IF 

18350 

Theta-Fcdat 

18360 

GOSUB Leg_isr 

18370 
18380 ! 

END IF 

18390 

IF Fcdat-999 THEN 

18400 

Lag flag$-" FEMUR C' 

18410 
18420 1 

END IF 

18430 

IF TcdatoO THEN 

.8440 

Leg$-"TIBIA C" 

.8450 

Theta-Tcdat 

.8460 

GOSUB Leg isr 

.8470 
.8480 ! 
.8490 1 

END IF 

.8500 

IF Yr<>0 THEN 

.8510 

Twirl$-"R0TATE Y" 

.8520 

Theta-Yr 

.8530 

GOSUB System isr 

.8540 
.8550 ! 

END IF 

.8560 

IF XroC THEN 

.8570 

Twirl $-"R0TATE X" 

.8580 

Theta-Xr 

.8590 

GOSUB System isr 

.8600 
.8610 1 

END IF 

.8620 

IF Zr<>0 AND Free<>2 THEN 

.8630 

Twirl$-"R0TATE Z" 

.8640 

Theta-Zr 

.8650 

GOSUB System isr 

.8660 
.8670 1 

END IF 

.8680 

IF Zr<>0 AND Free-2 THEN 

.8690 

Twirl$-"PIV0T" 

.8710 

Theta-Zr 

.8720 

GOSUB System_isr 

.8730 
.8740 ! 

END IF 

8750 

IF Tx<>0 THEN 

8760 

Way-1 

8770 

Theta-Tx 

8780 

Twirl$”"TRANSLATE" 

8790 

CALL Printmat (Total ( 

8800 

GOSUB Systeai_isr 

8810 

END IF 

8820 

IF Ty<>0 THEN 

8830 

Way=2 

8840 

Theta=Ty 

8850 

Twirl $="TRANSLATE" 

8860 

GOSUB System_isr 

8870 

END IF 

8880 

IF Tz<>0 THEN 

8890 

Way=3 

8900 

Theta=Tz 

8910 

Twirl $="TRANSLATE" 

8920 

GOSUB System_isr 


§18930 
18940 1 
18950 1 
18960 I 
18970 
18980 
JL8990 
*19000 
19010 
19020 
19030 
19040 
JL9050 
*9060 
19070 
19080! 
19090! 


END IF 


MAT Tempo (*,1:3)" Skit.ter(*, Is 3) 

MAT Temp- Tempo *Total 

MAT Skitmod (*,1:3)- Temp(*,l:3) 

MAT Newskit (*,1)- Skitmod(*,Screen_x) 
MAT Newskit (*, 2)- Skitmod(*,Screen_y) 
MAT Newskit (* , 3) ■ Skitmod ( * , 4 ) 

MAT Newskit(37:37,*)- Penl 
MAT Newskit (68:68,*)" Pen2 
MAT Newskit (99: 99,*)- Pen3 
OUTPUT 0Pathl;Newskit(*) 

GOTO Top 


19100 Movie:! 

J.9110 ASSIGN §Pathl TO * 

^9120 ASSIGN §Path2 TO * 

19130 CALL Display_movie(N,Skitwork$) 

19140 IF File_flag-1 THEN GOTO Finished 

19150 l 

19160 Save file:! 


J.9170 

*9180 

19190 

19200 

19210 

19220 

.19230 

*9250 

19260 

19270 

19280 

19290 


DISP "DO YOU WANT TO SAVE THE WORK FILE Y OR N"? 
LINPUT Ans$ 

IF Ans$o"Y" AND Ans$o"N" THEN GOTO 19170 
IF Ans$-"N" THEN GOTO Delete 
IF Ans?-"Y" THEN 

DISP "NAME OF FILE TO SAVE UNDER"; 

LINPUT Name? 

Where$-Name$ 

RENAME Skitwork? TO Where? 

DISP "FILE SAVED UNDER" ;Where? 

GOTO Finished 
END IF 


{ 


.9300 Delete:! 


9310 

19320 


19330 System_isr: 
19340 


PURGE Skitwork? 
GOTO Finished 


! 


19350 

19360 


SELECT Twirl? 

CASE "ROTATE Y" 

x ^ JOU CALL Rotate_y(Skitter(*),Skitmod(*),Total(*),Trans(*),Te 

|hp(*) ,Tempa(*) ,Sys rot y , Theta, Printflag?) 

19370 - ” CASE "ROTATE X" 

19380 CALL Rotate_x (Skitter (*) ,Skitmod(*) , Total (*) ,Trans(*) ,Ta 

mp(*) , Tempa ( * ) ,Sys_rot_x, Theta, Print flag?) 

19390! 

19400 CASE "ROTATE Z" 

8.9410 Theta=-Theta 

19420 CALL Rotate_z (Skitter (*) , Skitmod (*) , Total (*) , Trans (*) , :e 

»P(*) ,Tempa(*) ,Sys_rot_z, Theta, Printf lag?) 

19430! 

19440 CASE "TRANSLATE" , % 

£9450 CALL Translate _3d(Skitter(*) ,Skitmod(*) , Total (*) ,Temp ( k ) 

|Tempa ( * ) , Trans ( * ) , Sys_t rans_x , Sys_trans_y , Sys_trans_z , Way , Theta , Print flag? ) 


19460! 

19470 

19480 

19490 


CASE "PIVOT" 

IF Leg_flag$=" FEMUR A" THEN 
Theta=-Theta 


giounn P ivotx- ( Skitter (96 , 1) + Skitter (127,1) )/2 

^9510 Pivoty- ( Skitter (96, 2 )+Skitter( 127, 2) )/2 

19520 Pivot z- ( Skitter (96, 3 )+Skitter( 127, 3) )/2 

19530 Dist_piv_foot-SQR( (Pivotx-Skitter (65, 1) ) A 2+(Pivoty-Sk 

itter (65,2) ) A 2+ (Pivotz-Skitter (65, 3) ) A 2) 


19540 


jroty , -Pivot z ) 
*9550 


19550 

19560 

intflag$, Fem_a_ang, Flag) 

19570 

ty,Pivotz) 

19580 

19590 

19600! 

19610 

19620 

19630 

19640 

*9650 


itter (96, 2) ) A 2+ (Pivotz-Skitter (96, 3) ) A 2) 


CALL Trans_fem_orig(Skitter(*) , Skitmod (*) ,-Pivotx,-Pi 
Flag-0 

CALL Rotate_leg_z(Skitmod(*) ,Skitmod(*) ,Leg$, Theta, Pr 

CALL Trans_f em_orig (Skitmod ( *) , Skitmod ( * ) , Pivotx , Pivo 

MAT Skitter- Skitnod 
END IF 

IF Leg_flag$-" FEMUR B" THEN 

Pivotx- (Skitter (65, 1) +Skitter (127 , 1) ) /2 

Pivoty- ( Skitter (65,2) +Skitter ( 127 , 2 ) ) /2 

Pivot z- (Skitter (65,3) +Skitter ( 127 , 3 ) ) /2 

Dist_piv_foot— SQR( (Pivotx-Skitter (9 6, 1) ) A 2+(Pivoty-Sk 


19660 

voty, -Pivot z) 

19670 

^9680 

*9690 

intflag$,Fem_b ang,Flag) 

19700 

19710 

ty, Pivot z) 

JL9720 

*9730 

19740! 

19750 

19760 

19770 

19780 

*9790 


kitter(129,2) ) A 2+(Pivotz-Skitter(129,3) ) A 2) 


CALL Trans_fem_orig (Skitter (*) , Skitmod (*) , -Pivotx, -Pi 

CALL Rotate_leg_y (Skitmod (*) , Skitmod (*) ,60) 

Flag-0 

CALL Rotate_leg_z(Skitmod(*) , Skitmod (*) , Leg$, Theta, Pr 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

CALL Trans_fera_orig (Skitmod (*) ,Skitmod(*) , Pivotx, Pivo 

MAT Skitter- Skitmod 
END IF 

IF Leg_flag$»" FEMUR C" THEN 

Pivotx- (Skitter ( 65 , 1) +Skitter (96 , 1) ) / 2 

Pivoty- ( Skitter (65,2) +Skitter (96,2))/2 

Pivot z- ( Skitter (65,3) +Skitter (96,3))/2 

Dist_piv_foot-SQR( (Pivotx-Skitter (129, 1) ) A 2+(Pivoty-S 


19800 

voty, -Pivot z) 
i 19810 
19820 
•.9830 

intflag$, Fem_c_ang, Flag) 

19840 

19850 


CALL Trans_fem_orig(Skitter(*) ,Skitmod(*) , -Pivotx, -Pi 

CALL Rot a te_leg_y( Skitmod (*), Skitmod (*) ,-60) 

Flag— 0 

CALL Rotate_leg_z (Skitmod (*) ,Skitmod(*) , Leg$ , Theta , Pr 

CALL Rotate_leg_y (Skitmod ( * ) , Skitmod ( * ) , 6 0 ) 

CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) , Pivotx, Pivo 


19660 

MAT Skitter— Skitmod 

•9870 

END IF 

19880! 


19890 

END SELECT 

19900 

RETURN 

19910! 


19920 Leg isr: ! 


•9930 

SELECT Leg$ 

19940 

CASE "FEMUR A" 

19950 

MAT Femur- Skitter (3 

19960 

CALL Trans_fem_orig(: 

-Femur (3,2) , -Femur (3,3)) 


420480 Dist_piv foot-SQR((Pivotx-Skitter(96,l)) A 2+(Pivoty-Sk 

* tter (96 , 2 ) ) A 2+ (Pivotz-Skitter ( 96 , 3j) A 2 ) 


20490 Dist_y-Pivoty-Sk 

20500 Rot_ang-ASN ( Diet 

20510 CALL Trans_fem_o 

voty , -Pivot z) 

J0520 CALL Rotat«_lag 

*0530 Flag-0 

20540 CALL Rotate_leg_ 

Printf lag$ , Fera_b_ang , Flag) "" 

20550 CALL Rotate_leg_ 

20560 CALL Trans_fem o 

^y. Pivot z) 

*0570 MAT Skitter- Ski 

20580 MAT Tempa (*, 1:3) 

20590 MAT Temp- Temp a* 

20600 MAT Skitmod(*, 1: 

20610 1 
20620 l 

#0630 CASE "FEMUR C" 

20640 MAT Femur- Skitt 

20650 CALL Trans_fem_c 

-Femur(3,2) ,-Femur(3,3) ) 

20660 CALL Rotate_leg 

20670 Flag-1 

#0680 CALL Rotate_leg_ 

Printf lag$ , Fem c_ang,Flag) 

20690 “ CALL Rotate_leg_ 

20700 CALL Trans_fem_c 

) , Femur (3,2), Femur (3,3)) 

20710 MAT Skitter (99:1 

#0720! 

20730 IF Freeleg$-"FRE 

20740 MAT Femurtemp(*, 

20750 MAT Femur- Femur 

20760 MAT Skitmod(99:l 

20770 GOTO End leg 

#0780 END IF 

20790! 

20800 Pivotx-( Skitter ( 

20810 Pivoty=( Skitter ( 

20820 Pivot z- ( Skitter ( 

20830 Dist_piv_foot=SC 

•dtter (127, 2) ) A 2+( Pivotz-Skitter (127, 3) ) A 2) 


Dist_y-Pivoty-Skitter (96, 2) 
Rot_ang-ASN(Dist_y/Dist_piv foot) 

CALL Trans_fem_orig (Skitter (*) ,Skitmod(*) ,-Pivotx,-Pi 

CALL Rotate_leg_y(Skitmod(*) , Skitmod (*) ,60) 

Flag-0 

CALL Rotate_leg_z (Skitmod(*) ,Skitmod(*) , Leg$,Rot_ang, 

CALL Rotate_leg_y(Skitmod(*) ,Skitmod(*) ,-60) 

CALL Trans_fem_orig(Skitmod(*) ,Skitmod(*) ,Pivotx,Pivo 

MAT Skitter- Skitmod 

MAT Tempa (*,1:3)- Skitter (*,1:3) 

MAT Temp- Tempa *Total 

MAT Skitmod(*, 1:3)- Temp(*,l:3) 


CASE "FEMUR C" 

MAT Femur- Skitter (99: 129,*) 

CALL Trans_fem_orig (Femur (*) , Femurmod(*) , -Femur(3,l) , 

CALL Rotate_leg_y (Femurmod(*) ,Femurmod(*) ,-60) 

Flag-1 

CALL Rotate_leg_z(Femurmod(*) ,Femurmod(*) , Leg$, Theta, 

CALL Rotate_leg_y (Femurmod (*) , Femurmod ( * ) , 60) 

CALL Trans_f em_orig ( Femurmod ( * ) , Femurmod ( * ) , Femur (3,1 

MAT Skitter (99: 129,*)- Femurmod 

IF Freeleg$-"FREE" THEN 

MAT Femurtemp(*,l:3)« Femurmod (*, 1 : 3 ) 

MAT Femur- Femurtemp*Total 

MAT Skitmod (99:129,1:3)- Femur(*,l:3) 

GOTO End_leg 
END IF 

Pivo tx- (Skitter(65,l) +Skitter ( 9 6 , 1 ) ) /2 
Pivoty- (Skitter (65,2) +Skitter (96 , 2 ) ) /2 
Pivot z- ( Skitter (65,3) ^Skitter ( 9 6 , 3 ) ) /2 
Dist_piv_foot=SQR( (Pivotx-Skitter (127, 1) ) A 2+(Pivoty-S 


20840 

20850 

20860 

voty, -Pivot z) 

20870 

#0880 

20890 

Printf lag$ , Fem_c_ang , Flag) 

20900 

20910 

ty, Pivot z) 

#0920 

20930 

20940 

20950 

20960! 


Dist_y-Pivoty-Skitter (127,2) 

Rot_ang=*ASN ( Dist_y/Dist_piv_f oot ) 

CALL Trans_fem_orig (Skitter (*) ,Skitmod(*) ,-Pivotx,-Pi 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

Flag=0 

CALL Rotate_leg_z (Skitmod (*) , Skitmod (*) , Leg$ , Rot_ang , 

CALL Rotate_leg_y (Skitmod (*) , Skitmod (*) ,60) 

CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) ,Pivotx,Pivo 

MAT Skitter- Skitmod 

MAT Tempa(*, 1:3)- Skitter(*, 1:3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*, 1:3)= Temp(*,l:3) 


^09701 

^09801 


20990 

21000 

21010 

-Tibia(2,2) , -Tibia (2, 3)) 
,21020 
Sl030 
21040 

Printf lag$ , Tib a_ang,Flag) 
21050 
21060 


CASE "TIBIA A" 

MAT Tibia- Skitter(58:67,*) 

CALL Trane_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 
Flag-1 

CALL Rotate legy (Tibiamod(*) ,Tibiamod(*) , 180) 

CA LL Rotate“leg_z (Tibiamod (*) ,Tibiamod(*) ,Leg$, Theta, 

CALL Rotate leg_y (Tibiamod (*) ,Tibiamod(*) ,180) 

CALL Trans_f em_orig (Tibiamod (*) , Tibiamod ( * ) ,Tibia(2,l 


” MAT Skit ter (58: 67,*)- TitU.od 

UJSS 1 IF FreolegS-"FREE M THEN 

21100 MAT Tibiatemp (*,1:3)- Tibiamod(*, 1: 3) 

3 , 110 MAT Tibia- Tibiatemp*Total 

jJJJo MA T Skitmod (58:67,1:3)- Tibia(*,l:3) 

| 1130 GOTO End_leg 

21140 END IF 

1 Pivotx- (Skitter (96 , 1) +Skitter ( 127 , 1) ) /2 

,77?0 Pivoty- ( Skitter (96,2) ^Skitter ( 127 , 2 ) ) /2 

irtao Pivot z-( Skitter (96, 3 )+Skitter (127,3) )/2 

^ 11®0 Dist_piv_foot-SQR( (Pivotx-Skitter(65, 1) ) *2+ (Pivoty-Sk 

itter(65,2) ) A 2+ ( Pivot z-Skitter (65, 3) ) A 2) 

21200 Dist_y-Pivoty-Skitter (65, 2) 

3i3io Rot ang-ASN (Dist_y/Dist_piv_foot) 

21220 CALL Trans_fera_orig (Skitter (*) , Skitmod (*) , -Pivotx, -Pi 

voty,-Pivotz) 

*i 2 J jj CALL - Rotate_leg_z (Skitmod ( * ) , Skitmod ( * ) , Leg$ , -Rot_ang 

21250 tfla9$ ' Tib " a_ang ' Fla9)cALL Trans_fem_orig (Skitmod (*) ,Skitmod(*) , Pivotx, Pivo 

21260 V ° tZ ^ MAT Skitter- Skitmod 

^1270 MAT Tempa (*, 1: 3)- Skitter (*, 1: 3) 

3,280 MAT Temp- Tempa*Total 

21290 MAT Skitmod (*,1:3)- Temp(*,l:3) 

213001 

213101 

2,3,0 CASE "TIBIA B" 

fct^o MAT Tibia- Skitter (89: 98,*) 

*1340 CALL Trans_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 

21350 a(2 ' 2) '“ Tibia(2,3) } CALL Rotate_leg_y (Tibiamod(*) ,Tibiamod(*) , 60) 

2132 Q CALL Rotate_leg_z (Tibiamod(*) ,Tibiamod(*) , Leg$, Theta, 

^35o fla9$ ' Tib_b_an9 ' Fla9) CALL Rotate_leg_y(Tibiamod(*),Tibiamod(*),-60) 

21350 CALL Trans_fem_orig(Tibiamod(*) ,Tibiamod(*) , Tibia (2 , 1 

21400 ia(2 ' 2) ,Tibla(2 3)) MAT Skitter(89:98,*)- Tibiamod 

iJJIo 1 IF Freeleg$-"FREE" THEN 

2,^30 MAT Tibiatemp (*,1:3)— Tibiamod (*,1:3) 

MAT Tibia- Tibiatemp*Total 

21450 MAT Skitmod (89 :98,1:3)= Tibia(*,l:3) 

21460 GOTO End_leg 


CASE "TIBIA B" 

MAT Tibia- Skitter (89: 98,*) 

CALL Trans_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 

CALL Rotate_leg_y (Tibiamod (*) ,Tibiamod(*) , 60) 

Flag=l 

CALL Rotate_leg_z (Tibiamod(*) ,Tibiamod(*) , Leg$*Theta, 

CALL Rotate leg_y(Tibiamod(*) ,Tibiamod(*) ,-60) 

CALL Trans_fem_orig(Tibiamod(*) ,Tibiamod(*) , Tibia (2,1 

MAT Skitter(89:98,*)- Tibiamod 

IF Freeleg$-"FREE" THEN 

MAT Tibiatemp (*, 1:3)- Tibiamod (*,1:3) 

MAT Tibia- Tibiatemp*Total 

MAT Skitmod (89 :98,1:3)= Tibia(*,l:3) 

GOTO End_leg 


END IF 


J.tter ( 96 , 2 ) ) A 2+ ( Pivot z-Skitter ( 96 , 3 ) ) * 2 ) 
($1530 Dist_y«Pivoty 


Pivotx- (Skitter (65 , 1) +Skitter ( 127 , 1) ) /2 
Pivoty- (Skitter ( 65 , 2 ) +Skitter ( 127 , 2 ) ) /2 
Pivotz- (Skitter ( 65 , 3 ) +Skitter ( 12 7 , 3 ) ) / 2 
Dif*t_piv_foot-SQR( (Pivotx-Skitter (96, 1) ) A 2+(Pivoty-Sk 


21540 Rot_ang-ASN ( Diet 

21550 CALL Trans_fem_o 

voty, -Pivot z) 

21560 CALL Rotate_leg_ 

J1570 Flag-0 

($1580 CALL Rotate_leg_ 

Print flag$ , Tib_b_ang , Flag) 

21590 CALL Rotate_leg_ 

21600 CALL Trans_fem_o 

ty. Pivot z) 

21610 MAT Skitter- Ski 

^1620 MAT Tempa (*,1:3) 

21630 MAT Temp- Tempa* 

21640 MAT Skitmod(*, 1: 

216501 
216601 

21670 CASE "TIBIA C" 

^§1680 MAT Tibia- Skitt 

21690 CALL Trans_fem o 

-Tibia (2, 2) , -Tibia (2, 3)) 

21700 CALL Rotate_leg_ 

21710 Flag-1 

21720 CALL Rotate_leg_ 

%rintf lag$ , Tib_c_ang , Flag) 

21730 CALL Rotate_leg_ 

21740 CALL Trans_fem o 

) , Tibia (2 , 2) , Tibia (2, 3) ) 

21750 MAT Skitter (120: 

217601 

^11770 IF Freeleg$-"FRE 

21780 MAT Tibiatemp(*, 

21790 MAT Tibia- Tibia 

21800 MAT Skitmod (120: 

21810 GOTO End_leg 

21820 END IF 

• 18301 

21840 Pivotx- ( Skitter ( 

21850 Pivoty=( Skitter ( 

21860 Pi votz- (Skitter ( 

21870 Dist_piv_foot=SQ 

kitter(127, 2) ) A 2+(Pivotz-Skitter(127,3) ) A 2) 


Dist_y-Pivoty-Skitter (96,2) 

Rot_ang-ASN ( Dist < _y/Dist_piv_f oot ) 

CALL Trans_fera_orig(Skitter7*) , Skitmod (*) , -Pivotx, -Pi 

CALL Rotate_leg_y (Skitmod (*) , Skitmod (*) ,60) 

Flag-0 

CALL Rotate_leg_z (Skitmod (*) , Skitmod (*) ,Leg$,Rot_ang, 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) , Pivotx, Pivo 

MAT Skitter- Skitmod 

MAT Tempa (*,1:3)- Skitter (*, 1: 3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*, 1:3)- Temp(*,l:3) 


CASE "TIBIA C" 

MAT Tibia- Skitter (120: 129,*) 

CALL Trans_fem_orig (Tibia (*) ,Tibiamod(*) ,-Tibia(2,l) , 

CALL Rotate_leg_y(Tibiamod(*) ,Tibiamod(*) ,-60) 

Flag-1 

CALL Rotate_leg_z(Tibiamod(*) ,Tibiamod(*) ,Leg$, Theta, 

CALL Rotate_leg_y(Tibiamod(*) ,Tibiamod(*) ,60) 

CALL Trans_fem_orig(Tibiamod(*) ,Tibiamod(*) , Tibia (2,1 

MAT Skitter (120: 129,*)- Tibiamod 

IF Freeleg$-"FREE" THEN 

MAT Tibiatemp(*,l:3)- Tibiamod (*, 1 : 3 ) 

MAT Tibia- Tibiatemp*Total 

MAT Skitmod (120:129,1:3)- Tibia(*,l:3) 

GOTO End_leg 
END IF 

Pivotx- ( Skitter (65,1) +Skitter ( 9 6 , 1) ) /2 
Pivoty=(Skitter(65,2)+Skitter(96, 2) )/2 
Pivotz— (Skitter (65,3) +Skitter ( 96 , 3 ) ) /2 
Dist_piv_foot=SQR( (Pivotx-Skitter (127, 1) ) A 2+(Pivoty-S 


•1880 

21890 

21900 

voty, -Pivotz) 

21910 
21920 
• 1930 

Print flag$ , Tib_c_ang , Flag) 

21940 

21950 

ty, Pivotz) 


Dist_y-Pivoty-Skitter(127, 2) 

Rot_ang=ASN ( Dist_y/Dist_piv_f oot ) 

CALL Trans_fem_orig(Skitter(*) ,Skitmod(*) , -Pivotx, -Pi 

CALL Rotate_leg_y (Skitmod (*) ,Skitmod(*) ,-60) 

Flag-0 

CALL Rotate_leg_z (Skitmod (*) , Skitmod ( *) , Leg$ , Rot_ang, 

CALL Rotate_leg_y (Skitmod (*) , Skitmod (*) ,60) 

CALL Trans_fem_orig (Skitmod (*) , Skitmod (*) , Pivotx, Pivo 


.21960 
^11970 
21980 
21990 
22000 1 

22010 End leg: 1 
22020 ~ END SELECT 

^2030 RETURN 

22040! 

220501 


MAT Skitter* Skitnod 

MAT Tempa (*,1:3)- Skitter (■•>, 1: 3) 

MAT Temp- Tempa*Total 

MAT Skitmod(*,l:3)- Temp(*,l:3) 


22060 Windows:! 

220701 CALL Zoom_pan (Window$ , Screenx_win_min,Screenx_win_max, Screeny_wi 

njmin , Screeny_win_max , Ski tmod ( * ) ,Newskit(*) ,Screen_x,Screen_y) 

1(22080 GOTO Menu 

22090! ************************************************************************** 


22100 ! 

22110 Init: * INITIALIZE SCREEN, SKITTER 


22120! 


,22130 

DEG 

^2140 

GINIT 

22150 

GRAPHICS ON 

22160 

221701 

PLOTTER IS CRT, "INTERNAL" 

22180 

^2190! 

Dump_device-9 

^2200 

22210! 

Plot_device-705 

22220 

22230! 

READ Skitter (*) 

22240 

22250! 

MAT Skitmod- Skitter 

fe2260 

22270! 

MAT Femurtemp- (1) 

22280 

MAT Tibiatemp- (1) 

22290 

22300! 

MAT Trans- IDN 

22310 

1123201 

MAT Tempa- (1) 

22330 

22340! 

MAT Total- IDN 

22350 

22360! 

Menu$-"MAIN" 

22370 

*2380! 

Twirl$-"ROTATE Y" 

22390 

22400! 

Freeleg$-"FIXED" 

22410 

22420! 

Way-1 

22430 

*2440! 

Printflag$="OFF" 

22450 

22460! 

Increment-5 

22470 

22480! 

Rot_increment=3 

22490 

Screen_x=l 

P2500 

22510! 

Screen_y=2 

22520 

Sys_trans_x=0 

22530 

Sys_trans_y=0 

22540 

Sys trans_z=0 


! SET TO DEGREES 
1 INITIATE GRAPHICS 
l TURN G-PLANE ON 
l INIT PLOTTER 

1 READ SKITTER DATA 


1 INIT TRANS MATRIX TO IDN 

1 INIT MAIN MENU 

! AXIS OF TRANS X=1,Y=2,Z=3 

TRANS INC. 

! INIT VIEW PLANE 
1 X=1 , Y=2 , Z=3 

! INIT POSITONS OF SYSTEM 


I 


£2550 

22560 

22570 

22580! 

22590 

22600 

£2610 

72620 

22630 

22640 

22650! 

22660 

£2670 

72680 

22690 

22700 

22710! 

22720 

£2730! 

72740! 

22750! 

227601 


Sys_rot_x_-0 

sy«^rot_y"0 

sys_rot_z-o 

Fem_a_ang-0 

Fera_b_ang-0 

Fen c“ang-0 

Tib“a_ang«90 

Tib_b_ang«90 

Tib_c_ang-90 


! INIT LEG ANGLES 


I SET WINDOW 


Screenx_win_nax"40 
Screenx_win_min— 20 
Screeny_win_max-4 0 
Screeny win_nin»-20 

SHOW Screenx_win_min , Screenx_vin_max, Screeny_win_nin , Screeny_win_max 
• RETURN 

************************************************************************** 

************************************************************************** 


22770! 

22780 Finished: 

£2790 GCLEAR 

72800 CLEAR SCREEN 

22810 SUBEND 

22820! 

22830 SUB Display_movie(N,Skitwork$) 
22840 1 

22850 OPTION BASE 1 

22860 DIM Newski t (129,3) 

22870 ON KBD GOTO Leave 

22880 DISP "HIT ANY KEY TO QUIT” 

22890 ASSIGN 8Pathl TO Skitwork$ 

22900 ON END GPathl GOTO Start_again 

22910 ENTER 6Pathl;Newskit (*) 

fe2920 CLEAR SCREEN 

22930 GCLEAR 

22940 FRAME 

22950 AREA INTENSITY 0,0,. 2 

22960 MOVE -100, -.5 

22970 RECTANGLE 200, .5, FILL, EDGE 

22980 PLOT Newskit(*) 

22990 LINE TYPE 1 

23000 GOTO 22910 

23010 Start_again: ! 

23020 ASSIGN GPathl TO * 

23030 GOTO 22890 

23040 Leave: ! 

23050 ASSIGN fiPathl TO * 

23060 SUBEND 


1 DONE WITH PROGRAM 


Appendix C 

SKITTER Dynamic Simulation 
Program Listing 


REM*** ********"""" w 

R£M 

REM THIS PROGRAM WILL ALLOW THE USER 
REM TO DETERMINE WHETHER OR NOT A 
REM PARTICULAR ACTUATOR WILL PROVIDE 
REM SUFFICIENT TORQUE AND ANGULAR 
REM VELOCITY TO HAVE SKITTER JUMP A 
REM 

REM TO DOS THIS , A INVERSE SLIDER CRANK 
REM MECHANISM WILL BE SIMULATED. JOINT 
REM ANGLES, VELOCITIES, AND ACCELERATIONS 
REM WILL BE CALCULATED ALONG WITH THE TORQUES. 

REM 

REM PROGRAM WRITTEN BY: 

REM BRICE MACLAREN 

REM GARY MCMURRAY 

jjjj *********************************************************** 

RAD 

OPTION BASE 1 **************************** 

REM******************************** 

DIM A(4) , B(4) ,C(4) , D(4 ) ,E(4) ,F(4) ,Rotl(4,4) ^ R °«(4,4) ,Rot3(4,4) 

DIM Femur (4) , Foot (4) ,Tibcon(4) , Of lag (6) ,Transl(4,4) , Matrix (^4, 4) 

DIM Trans2 (4,4), Trans3 (4,4), Newf am ( 4 ) , Newf oot ( 4 ) , Tempi ( 4 ) , Diet ( 4 ) 
dtm MawbMl Newd(4) ,Newe(4) ,Newfem2(4) ,Temp2(4) ,Temp3(4) 

DIM Ftorque(800) ,Ttorque(800) ,Fomega(800) ,Tomega(800) ,Fhp(800) ,Thp(200) 
DIM Origb(4) ,Origd(4) ,Orige(4) ,Newfoot2(4) 

DIM Temp$(8] 

$^J*********************************************************** 

REM 

REM INITIALIZE VARIABLES 

REM 

Del step- 1 

G— 32.2 

Jdist-6/12 

Adist-3/12 

Wgt-300 

Mfemur-10/G 

Mtibia-6/G 

Flen-20/12 

Tlen*20/12 

Beta-0 

CALL Invar (Mfemur, lfemur,Flen,Mtibia,Itibia,Tlen) 

MAT Trans 3- IDN 
MAT Trans2- IDN 
MAT Trans 1- IDN 
Angf=23 . 62 
Angt-27 . 5 
Aforce-100 
Avel-5 
Avel-Avel/12 
Atorque=100 


Sem*^**************************************************************** 


REM WHAT FOLLOWS ARE THE ORIGINAL POINT LOCATIONS FOR THE VARIOUS 


|600 

<10 

620 

630 

640 

650 

.660 

%70 

680 

690 

700 

710 

720 

730 

740 

750 

760 

770 

780 

*?90 

800 

810 

820 

830 


REM CONNECT POINTS " THEY ARE, IN ORDER, PNT.A,B,C,D,E, & F. PLEASE 
REM THE DOCUMENTATION FOR DEFINITIONS OF THESE POINTS. 

REM 

REM****************************************************************** 

DATA -1.95,7.5095,0,1 

DATA 9.576,4.09,0,1 

DATA 0,0,0, 1 

DATA 11.411,-4.09,0,1 

DATA 23.714,-11.7685,0,1 

REM 

READ A(*) 

READ B(*) 

READ C(*) 

READ D(*) 

READ E(*) 

R£|f ****************************************************************** 

REM 

REM' THE NEXT 3 DATA STATEMENTS ARE FOR THE ORIGINAL VECTORS OF THE 
REM FEMUR, FOOT, AND THE CONNECTION POINT OF THE ACTUATOR TO THE 
REM TIBIA (THE LAST TWO ARE RELATIVE TO THE FEMUR END POINT) 

REM 

REM******************************************************************* 
DATA 20,0,0,1 
DATA -20,0,0,1 


840 

DATA 6.95,-11.71,0,1 



fe50 

REM 



860 

READ Femur (*) 



870 

READ Foot (*) 



880 

READ Tibcon(*) 



890 

l CONVERT INCHES TO FEET 



900 

FOR 1-1 TO 3 



1910 

A(I)-A(I)/12 



920 

B(I)-B(I)/12 



930 

C(I)-C(I)/12 



940 

D(I)-D(I)/12 



950 

E(I)-E(I)/12 



960 

Femur ( I ) -Femur ( I ) / 12 



670 

Foot (I) -Foot (I)/12 



980 

Tibcon ( I ) -Tibcon ( I ) / 12 



990 

NEXT I 



1000 

Flag=0 

i FLAG 

CONTROLS 

1010 

Simflag-0 

1 FLAG 

CONTROLS 

1020 

Rflag-1 

1 FLAG 

CONTROLS 

6030 

FOR 1-1 TO 6 



1040 

Oflag(I)=0 ! 

OFLAG CONROLS W1 

1050 

NEXT I 



1060 

Menu: ! 



1070 

CLEAR SCREEN 



1080 

CALL Invar (Mf emur , If emur , Flen,Mtibia 


6090 

1100 


IF FlagoO THEN 

CALL Printvar(Jdist,Adist,Wgt,G,Mfemur,Flen,Mtibia,Tlen, Angf , 


Angt, A(*) ,B(*) ,C(*) , D ( *) , E ( *) , Beta, Iota, Aforce,Avel,Actflag, Atorque, Aomega) 


1110 


ELSE 


1120 


DISP "CHOOSE 

TYPE OF ACTUATOR" 

1130 


END IF 


L140 

REM 



1150 

REM 

NOW THE MENUS ARE 

DEFINED 

1160 

REM 



1170 

SELECT 

Flag 


L180 

CASE 0 




1190 

1200 

1210 

1220 

1230 

1240 

1250 

l260 

1270 

1280 

1290 

1300 

1310 

1320 

1330 

1340 

1350 

1360 

1370 

1380 

1390 

1400 

1410 

1420 

1430 

1440 

1450 

1460 

1470 

1480 

1490 

1500 

1510 

1520 

1530 

1540 

1550 

1560 

1570 

1580 

1590 

1600 

1610 

1620 

1630 

L640 

1650 

L660 

L670 

1680 

1690 

L700 

1710 

1720 

'730 

L740 

.750 

.760 

.770 

.780 


ON KEY 0 LABEL "ROTARY ACT." GOTO Ract 

ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "" GOTO Try 

ON KEY 3 LABEL "" GOTO Try 

ON KEY 4 LABEL "LINEAR ACT." GOTO Lact 


ON KEY 5 LABEL "" GOTO Try 
ON KEY 6 LABEL "" GOTO Try 
ON KEY 7 LABEL "STOP" GOTO St 


ON KEY 8 LABEL "" GOTO Try 
ON KEY 9 LABEL "" GOTO Try 


CASE 1 

ON KEY 0 LABEL "JUMP DISTANCE" GOTO Jd 
ON KEY 1 LABEL "ACCELERATION DIST" GOTO Ad 
ON KEY 2 LABEL "LEG PROPERTIES" GOTO Lp 
ON KEY 3 LABEL "JOINT LOCATIONS" GOTO Jnt 
ON KEY 4 LABEL "ACTUATORS" GOTO Act 
ON KEY 5 LABEL "CHANGE ACT" GOTO Cha 
ON KEY 6 LABEL "DATA FILES" GOTO Fn 
ON KEY 7 LABEL "STOP" GOTO St 
ON KEY 8 LABEL "PRINTER IS 7" GOTO Prnt 
ON KEY 9 LABEL "RUN DATA" GOTO Rn 


CASE 2 

ON KEY 0 LABEL "FEMUR MASS" GOTO Fm 
ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "INIT FEMUR ANGLE" GOTO Fang 
ON KEY 3 LABEL "" GOTO Try 
ON KEY 4 LABEL "LEG LENGTH" GOTO Lien 
ON KEY 5 LABEL "TIBIA MASS" GOTO Tm 
ON KEY 6 LABEL "" GOTO Try 

ON KEY 7 LABEL "INIT TIBIA ANGLE" GOTO Tang 
ON KEY 8 LABEL "MAIN MENU" GOTO Mm 
ON KEY 9 LABEL "RUN DATA" GOTO Rn 
CASE 3 

ON KEY 0 LABEL "POINT A" GOTO Bal 
ON KEY 1 LABEL "" GOTO Try 
ON KEY 2 LABEL "POINT B" GOTO Ba2 
ON KEY 3 LABEL "" GOTO Try 
ON KEY 4 LABEL "POINT D" GOTO Tal 
ON KEY 5 LABEL "" GOTO Try 
ON KEY 6 LABEL "POINT E" GOTO Ta2 
ON KEY 7 LABEL "" GOTO Try 
ON KEY 8 LABEL "MAIN MENU" GOTO Mm 
ON KEY 9 LABEL "RUN DATA" GOTO Rn 


CASE 4 

ON KEY 0 LABEL "FEMUR FILES" GOTO Cf 
ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "TIBIA FILES" GOTO Tibfiles 

ON KEY 3 LABEL "" GOTO Try 

ON KEY 4 LABEL "SIMULATION " GOTO Simfil 

ON KEY 5 LABEL "" GOTO Try 

ON KEY 6 LABEL "CLOSE FILES" GOTO Clf 

ON KEY 7 LABEL "" GOTO Try 

ON KEY 8 LABEL "MAIN MENU" GOTO Mm 

ON KEY 9 LABEL "RUN DATA" GOTO Rn 


CASE 5 

ON KEY 0 LABEL "TORQ VS JDIST" GOTO Ft] 

ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "OMEQA VS JDIST" GOTO Fo] 

ON KEY 3 LABEL "" GOTO Try 

ON KEY 4 LABEL "HP VS JDIST" GOTO Fhj 


-1790 

*i800 

1810 

1820 

1830 

1840 

1850 

QL860 

1870 
1880 
1890 
1900 
1910 
•L920 
1930 
1940 
1950 
1960 
1970 
*L980 
1990 
2000 
2010 
2020 
2030 
Ife040 
2050 
2060 
2070 
2080 
2090 
felOO 
2110 
2120 
2130 
■ 2140 
2150 
£160 
2170 
2180 
2190 
2200 
2210 
£220 
2230 
2240 
2250 
2260 
2270 
£280 
2290 
2300 
2310 
2320 
2330 
£340 
2350 
2360 
2370 
2380 


ON KEY 5 LABEL "" GOTO Try 
ON KEY 6 LABEL "" GOTO Try 
ON KEY 7 LABEL "" GOTO Try 
ON KEY 8 LABEL "MAIN MENU" GOTO Mm 
ON KEY 9 LABEL "RUN DATA" GOTO Rn 

CASE 6 

ON KEY 0 LABEL "TORQ VS JDIST" GOTO Ttj 

ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "OMEQA VS JDIST" GOTO Toj 

ON KEY 3 LABEL "" GOTO Try 

ON KEY 4 LABEL "HP VS JDIST" GOTO Thj 

ON KEY 5 LABEL "" GOTO Try 

ON KEY 6 LABEL "" GOTO Try 

ON KEY 7 LABEL "" GOTO Try 

ON KEY 8 LABEL "MAIN MENU" GOTO Mm 

ON KEY 9 LABEL "RUN DATA" GOTO Rn 

CASE 7 , 

ON KEY 0 LABEL "MAX FORCE" GOTO Actf 

ON KEY 1 LABEL "" GOTO Try 

ON KEY 2 LABEL "MAX VELOCITY" GOTO Actv 

ON KEY 3 LABEL "" GOTO Try 

ON KEY 4 LABEL "" GOTO Try 

ON KEY 5 LABEL "" GOTO Try 


ON 

KEY 

6 

LABEL 

»" GOTO Try 

ON 

KEY 

7 

LABEL 

"" GOTO Try 

ON 

KEY 

8 

LABEL 

"MAIN MENU" GOTO Mm 

ON 

KEY 

9 

LABEL 

"RUN DATA" GOTO Rn 

CASE 8 
ON 

KEY 

0 

LABEL 

"MAX TORQUE" GOTO Actt 

ON 

KEY 

1 

LABEL 

"" GOTO Try 

ON 

KEY 

2 

LABEL 

"MAX OMEGA" GOTO Acto 

ON 

KEY 

3 

LABEL 

«" GOTO Try 

ON 

KEY 

4 

LABEL 

"" GOTO Try 

ON 

KEY 

5 

LABEL 

"" GOTO Try 

ON 

KEY 

6 

LABEL 

"" GOTO Try 

ON 

KEY 

7 

LABEL 

"" GOTO Try 

ON 

KEY 

8 

LABEL 

"MAIN MENU" GOTO Mm 

ON 

KEY 

9 

LABEL 

"RUN DATA" GOTO Rn 

CASE 9 
ON KEY 

0 

LABEL 

"CRT" GOTO Pert 

ON 

KEY 

1 

LABEL 

"" GOTO Try 

ON 

KEY 

2 

LABEL 

•in goto Try 

ON 

KEY 

3 

LABEL 

"" GOTO Try 

ON 

KEY 

4 

LABEL 

"LASER" GOTO Las 

ON 

KEY 

5 

LABEL 

"" GOTO Try 

ON 

KEY 

6 

LABEL 

•••• goto Try 

ON 

KEY 

7 

LABEL 

"" GOTO Try 

ON 

KEY 

8 

LABEL 

"MAIN MENU" GOTO Mm 

ON 

KEY 

9 

LABEL 

"RUN DATA" GOTO Rn 

CASE : 
ON 

10 

KEY 

0 

LABEL 

"JUMP DISTANCE" GOTO Jd 

ON 

KEY 

1 

LABEL 

•tn GOTO Try 

ON 

KEY 

2 

LABEL 

"" GOTO Try 

ON 

KEY 

3 

LABEL 

mm GOTO Try 

ON 

KEY 

4 

LABEL 

"ACCELERATION" GOTO Ad 

ON 

KEY 

5 

LABEL 

mm GOTO Try 

ON 

KEY 

6 

LABEL 

•mi goto Try 

ON 

KEY 

7 

LABEL 

mm goto Try 

ON 

KEY 

8 

LABEL 

"MAIN MENU" GOTO Mm 

ON 

KEY 

9 

LABEL 

"RUN DATA" GOTO Rn 


^o/kEY 0 LABEL "FIND MAX VALS" GOTO Fmv 
ON KEY 1 LABEL "" GOTO Try 
ON KEY 2 LABEL "" GOTO Try 
ON KEY 3 LABEL "" GOTO Try 
ON KEY 4 LABEL "INCREMENTAL" GOTO Inc 
ON KEY 5 LABEL "" GOTO Try 
ON KEY 6 LABEL "" GOTO Try 
ON KEY 7 LABEL "" GOTO Try 
ON KEY 8 LABEL "MAIN MENU" GOTO Mm 
ON KEY 9 LABEL "RUN DATA" GOTO Rn 
END SELECT 
GOTO 2510 

1 BEGIN SOFTKEY DEFINATIONS 
Fact: ■ AC1 


Lact : 


Rcond: 


Ad: 1 


Jnt: 


Prnt 


BEGIN SOFTKEY DEFINATIONS 

j ACTUATORS WILL BE ROTARY 

Actflag-1 

Flag-1 

GOTO Menu ACTUATORS WILL BE LINEAR 

: l 

Actflag-2 

Flag-1 

GOTO Menu G0 RUN CONDITIONS MENU 

d • * 

Flag-11 

GOTO Menu INPUT A NEW JUMP DISTANCE 

DISP "DISTANCE YOU DESIRE SKITTER TO JUMP (IN INCHES)"; 

INPUT Jdist 
Jdist*Jdist/12 

GOTO Menu INPUT A N EW ACCELERATION DISTANCE 

DISP "ACCELERATION DISTANCE FOR FOOT (IN INCHES)"; 

INPUT Adist 
Adist-Adist/ 12 

GOTO Menu GO TQ M ENU 

Flag-2 

GOTO Menu GO T£) J0INT menu 

Flag-3 

GOTO Menu GQ TQ ACTUATO r MENU 

IF Actflag-1 THEN 
Flag=8 
ELSE 

Flag-7 
END IF 

GOTO Menu CHANGE TYPE OF ACTUATORS 

: ! 

Flag-0 

GOTO Menu CHANGE PRINTER 

t: ! 

Flag=9 

GOTO Menu TnmprTMun cnPTifFV CHOOSEN. TRY AGi 


GO TO LEG MENU 


GO TO JOINT MENU 


GO TO ACTUATOR MENU 


CHANGE TYPE OF ACTUATORS 


CHANGE PRINTER 


Try: 


DISP "BAD CHOICE — TRY AGAIN" 
GOTO Menu 


UNDEFINED SOFTKEY CHOOSEN, TRY AGAIN 


GO TO DATA FILE MENU 


EXIT THE PROGRAM 


990 

000 

010 St: 

020 

030 

040 

050 

060 

070 

080 Rn: 
090 
100 

110 Fm: 
120 
130 
140 
150 

160 Lien: 

170 

180 

190 

200 

210 

220 Tm: 
230 
240 
250 
260 

270 Fang: 

280 

290 

300 

310 

320 Tang: 
330 
340 
150 
160 
170 

180 Mm: 
190 
100 

110 Bal: 
120 
130 
140 
150 
160 
170 
180 
190 
>00 
>10 
120 
130 
140 
150 
•60 
70 
80 


Flag-4 

GOTO Menu 
1 

PRINTER IS CRT 
CLEAR SCREEN 

DISP "PROGRAM TERMINATED" 

WAIT 1 

DISP "OR IS IT????" 

STOP 

1 RON PROGRAM WITH DATA AS IT IS 

Flag-11 

GOTO Menu 

l INPUT WEIGHT OF FEMUR 

DISP "FEMUR WEIGHT (IN POUNDS FORCE) "; 

INPUT Mfemur 
Mfemur-Mfemur/G 
GOTO Menu 

1 INPUT LENGTH OF LEGS 

DISP "LEG LENGTH (IN INCHES)"? 

INPUT Flen 
Flen«F.len/12 
Tlen-Flen 
GOTO Menu 

l INPUT WEIGHT OF TIBIA 

DISP "TIBIA WEIGHT (IN POUNDS FORCE) "; 

INPUT Mtibia 
Mtibia-Mtibia/G 
GOTO Menu 

! INPUT INITIAL ANGLE OF FEMUR 

DISP "INITIAL ANGLE BETWEEN FEMUR AND HORIZONTAL (IN DEGREES)"; 
INPUT Beta 
Beta-Beta* PI/ 180 
GOTO Menu 

! INPUT INITIAL ANGLE BETWEEN 

1 FEMUR AND TIBIA 

DISP "INITIAL ANGLE BETWEEN FEMUR AND TIBIA (IN DEGREES)"? 

INPUT Iota 
Iota-Iota*PI/180 
GOTO Menu 

1 GO BACK TO MAIN MENU 

Flag-1 

GOTO Menu 

1 CHANGE PNT. A 

DISP "POINT A - X COORDINATE (DEFAULT - ",A(1) *12, "IN. ) "? 

LINPUT Temp$ 

IF Temp$=" " THEN 
ELSE 

A(l) -VAL(Temp$) 

A(1)«A(1)/12 
END IF 

DISP "POINT A - Y COORDINATE (DEFAULT - " , A(2) *12 , "IN. ) " ? 

LINPUT Temp$ 

IF Temp$="" THEN 
ELSE 

A(2) =VAL(Terop$) 

A(2)=A(2)/12 
END IF 

DISP "POINT A - Z COORDINATE (DEFAULT = ",A(3) *12, "IN. ) "? 

LINPUT Temp$ 

IF Temp$=" " THEN 


880 

890 

900 

910 

920 

930 

940 

950 

960 

970 

980 

990 

000 

010 

020 

030 

040 

050 

060 

070 

080 

090 

100 Ta2 : 
110 
120 
130 
140 
150 
160 
170 
180 


ELSE 

A(3)-VAL(Temp$) 

A(3)-A(3)/12 
END IF 
GOTO Menu 

DISP "POINT B - X COORDINATE ( 
LINPUT Temp$ 

IF Temp$-"" THEN 
ELSE 

B(l)-VAL(Temp$) 

B(l)-B(l)/12 
END IF 

DISP "POINT B - Y COORDINATE | 
LINPUT Temp$ 

IF Temp$“"" THEN 
ELSE 

B(2) =VAL(Temp$) 
B(2)-B(2)/12 
END IF 

DISP "POINT B - Z COORDINATE 
LINPUT Temp$ 

IF TempS-"" THEN 
ELSE 

B(3)«VAL(Temp$) 
B(3)=B(3)/12 
END IF 
GOTO Menu 
l 

DISP "POINT D - X COORDINATE 
LINPUT Temp$ 

IF Terap$-"" THEN 
ELSE 

D(l)=VAL(Temp$) 
D(1)“D(1)/12 
END IF 

DISP "POINT D - Y COORDINATE 
LINPUT Temp$ 

IF Temp$=" " THEN 
ELSE 

D ( 2 ) =VAL (Temp$ ) 

D (2 ) =*D ( 2 ) /12 
END IF 

DISP "POINT D - Z COORDINATE 
LINPUT Temp$ 

IF Temp$="" THEN 
ELSE 

D(3) =VAL(Temp$) 

D ( 3 ) =»D ( 3 ) /12 
END IF 
GOTO Menu 

t 

DISP "POINT E - X COORDINATE 
LINPUT Temp$ 

IF Temp$=" " THEN 
ELSE 

E(l)=VAL(Temp$) 

E ( 1 ) =E ( 1) /12 
END IF 

DISP "POINT E - Y COORDINATE 


CHANGE PNT. B 

(DEFAULT - H , B(l) *12 # "IN. ) " * 


(DEFAULT - " ,B(2) *12, "IN. ) " # 


(DEFAULT “ ",B(3) *12, "IN. ) "; 


CHANGE PNT. D 

(DEFAULT * ",D(1)*12,"IN.)"; 


(DEFAULT «= ",D(2) *12, "IN. ) 


(DEFAULT - ",D(3)*12, "IN. ) " # 


CHANGE PNT. E 

(DEFAULT = ",E(1)*12,"IN.)"; 


(DEFAULT = " , E ( 2 ) * 1 2 , " IN . ) " J 



UNPOT Temp$ 

IF Tcap$-"" THEN 
ELSE 

2(2)-VAL(Temp$) 

E(2)-E(2)/12 
END IF 

DISP "POINT E - Z COORDINATE (DEFAULT 
LIN PUT Temp$ 

IF Temp$-"" Tl’EN 
ELSE 

E(3)-VAL(Temp$) 

E(3)-E<3)/12 


",E(3)*12,"IN.)"? 


4310 

END IF 



T320 

GOTO Menu 



4330 Cf: 

1 



4340 

Flag-5 



4350 

GOTO Menu 



4360 Tibfiles: 1 



A370 

Flag-6 



*380 

GOTO Menu 


4390 Clf : 

l 



4400 

ASSIGN ePathl 

TO 

* 

4410 

ASSIGN @Path2 

TO 

* 

4420 

ASSIGN 0Path3 

TO 

* 

4430 

ASSIGN €Path4 

TO 

* 

*440 

ASSIGN @Path5 

TO 

* 

4450 

ASSIGN 0Path6 

TO 

* 

4460 

ASSIGN 6 Paths im TO 

4470 

FOR 1-1 TO 6 



4480 

Oflag(I)=0 



4490 

NEXT I 



*500 

GOTO Menu 




CREATE DATA FILES FOR FEMUR 


CREATE DATA FILES FOR TIBIA 


CLOSE ALL DATA FILES 


1 THIS CREATES A BDAT FILE THE OUTPUT OF THE 

l ANGLES FOR THE SIMULATION OF SKITTER 

DISP "FILE NAME FOR THE SIMULATION FILE "j 
LINPUT Sim$ 

CREATE BDAT Sim$,200 
ASSIGN SPathsim TO Sim$ 

Simflag=l 
GOTO Menu 

j CREATE TORQUE vs JUMP DISTANCE FILE FOR FEMUR 

DISP "FILE NAME FOR TORQUE VS JUMP DISTANCE "? 

LINPUT Tvj$ 

CREATE ASCII Tvj$,25 
ASSIGN ®Pathl TO Tvj$ 

Oflag(l)-l 

GOTO Menu CREATE OMEGA vs JUMP DISTANCE FILE FOR FEMUR 

DISP "FILE NAME FOR OMEGA VS JUMP DISTANCE "; 

LINPUT Ovj$ 

CREATE ASCII Ovj$,25 
ASSIGN §Path2 TO Ovj$ 

Oflag(2)«l 

GOTO Menu CREATE HP VS JUMP DISTANCE FILE FOR FEMUR 

DISP "FILE NAME FOR HORSE POWER VS JUMP DISTANCE "; 

LINPUT Hvj$ 

CREATE ASCII Hvj$,25 
ASSIGN 6Path3 TO Hvj$ 

Oflag(3)=l 


Ttj : 


Toj : 


Thj : 


•4790 
' 4800 
4810 
4820 
4830 
4840 

I <11 

4870 
4480 
4890 
4900 

U fi 910 
4920 
4930 
4940 
4950 
4960 
-4970 
^1980 
4920 
5000 

5010 Actf: 
5020 
5030 
%040 
5050 Actv: 
5060 
5070 
5080 
5090 

%100 Actt: 
5110 
5120 
5130 

5140 Acto: 
5150 
45160 
5170 

5180 Pert: 
5190 
5200 
5210 

45220 Las: 
5230 
5240 
5250 

5260 Fmv: 
5270 
45280 
5290 
i 5300 
; 5310 
5320 

5330 Inc: 
1^340 
j 5350 
5360 

5370 Rest: 
5380 


GOTO Menu CREATE TORQUE vs JUMP DISTANCE FILE FOR TIBIA 

DISP "FILE NAME FOR TORQUE VS JUMP DISTANCE "; 

LINPUT Tvj $ 

CREATE ASCII Tvj $,25 
ASSIGN 8Path4 TO Tvj$ 

Oflag(4)-l 

GOTO Menu CREATE OMEGA VS JUMP DISTANCE FILE FOR TIBIA 

DISP "FILE NAME FOR OMEGA VS JUMP DISTANCE " J 
LINPUT Ovj$ 

CREATE ASCII Ovj$,25 
ASSIGN ®Path5 TO Ovj$ 

0flag(5)-l 

GOTO Menu CREATE HP vs JUMP DISTANCE FILE FOR TIBIA 

DISP "FILE NAME FOR HORSE POWER VS JUMP DISTANCE "J 
LINPUT Hvj$ 

CREATE ASCII Hvj$,25 
ASSIGN ®Path6 TO Hvj$ 

Oflag(6)-l 

GOTO Menu INPUX MAXIMUM FORCE ACTUATOR CAN EXERT 

DISP "MAXIMUM FORCE ACTUATOR CAN EXERT (IN POUNDS FORCE) "; 

INPUT Aforce 

GOTO Menu INPUT MAXIMUM VELOCITY ACTUATOR CAN ACHIEVE 

DISP "MAXIMUM ACTUATOR VELOCITY ACHIEVE (IN IN/SEC) "; 

INPUT Avel 
AveI-Avel/12 

GOTO Menu INPUT MAXIMUM TORQUE ACTUATOR CAN EXERT 

DISP "MAXIMUM TORQUE ACTUATOR CAN EXERT (IN FT-LBS) "; 

INPUT Atorquci 

GOTO Menu INPUT MAXIMUM VELOCITY ACTUATOR CAN ACHIEVE 

DISP "MAXIMUM ACTUATOR OMEGA ACHIEVE (IN RAD/SEC) "? 

INPUT Aomega 


GOTO Menu 
! 

PRINTER IS CRT 
Flag-1 
GOTO Menu 
i 

PRINTER IS 9 
Flag-1 
GOTO Menu 


MAKE PRINTER CRT 


MAKE PRINTER THE LASER JET 


l 


RUNS THE PROGRAM TO FIND MAX TORQUE & OMEGA 
DISP "NUMBER OF STEPS PER INCH OF ACCELERATION "j 
INPUT Del step 
Delstep-l/Delstep 
Rflag=2 
Flag-1 
GOTO Rest 


! 

Rflag=l 
Flag=l 
GOTO Rest 

j 

Flag=l 


RUNS THE PROGRAM ON AN INCREMENTAL SETTING 


RUN THE PROGRAM WITH THE VALUES AS SET 


1390 

5400 

5410 

5420 

5430 

5440 

5450 

?460 

5470 

5480 

5490 

5500 

5510 

B20 

5530 

5540 

5550 

5560 

5570 

R80 

5590 

5600 

>610 

5620 

5630 

RS40 

5650 

5660 

5670 

5680 

5690 

&700 

5710 

>720 

>730 

>740 

>750 

*60 

•770 

1780 

1790 

1800 


810 

*20 

830 

'840 

850 

860 

870 

*80 

890 

900 

910 

920 

930 

MO 

950 

960 

970 

980 


CLEAR SCREEN 

! if NO FILE ASSIGNMENTS HAVE BEEN MADE, THEN OUTPUT IS TO THE CRT 
I 

IF Oflag(l)-0 THEN 

ASSIGN QPathl TO CRT 
END IF 

IF 0flag(2)-0 THEN 

ASSIGN ®Path2 TO CRT 
END IF 

IF Of lag (3) -0 THEN 

ASSIGN §Path3 TO CRT 
END IF 

IF Oflag(4)-0 THEN 

ASSIGN € Path 4 TO CRT 
END IF 

IF Oflag(5)-0 THEN 

ASSIGN ®Path5 TO CRT 
END IF 

IF Of lag (6) -0 THEN 

ASSIGN §Path6 TO CRT 
END IF 

J ******************************************************************* 
! 

1 START THE PROGRAM 


! DEFINE YOUR END CONDITIONS 
1 

Maxvel-SQR ( 2*G* Jdist ) 

Totaltime-ABS (2*Adist/Maxvel) 

Accel-Maxvel/Tota 1 t ime 
1 

1 DETERMINE ANGLES FOR THIS POSITION OF THE FOOT 

CALL Findfoot(-l*Beta, Iota, Femur (*) ,Foot(*) ,Newfoot(*) ,Newfem(*)) 

1 

I 

1 DEFINE ORIGINAL LOCATION OF ACTUATOR CONNECT POINTS FOR THIS 

1 CONFIGURATION OF THE LEGS 

! 

CALL Rot (-l*Beta,Transl (*) ) 

MAT Origb- Transl*B 
MAT Origd- Transl*D 
MAT Temp 2- E-Femur 
Temp2 ( 4 ) =1 

MAT Tempi- Trans3*Temp2 
Xnew=Newf oot ( 1 ) 

Ynew=Newf oot ( 2 ) 

Lac”SQR ( Xnew A 2 + ( Ynew ) A 2) 

CALL Sss(Tlen,Lac,Flen,A3) 

A3-A3-PI/2 

CALL Rot(A3 ,Trans2 (*) ) 

CALL Trans (Newfem(*) ,Trans2(*) ) 

MAT Orige” Trans2*Templ 

I 
I 
i 


SET END POINTS FOR LOOPING OVER SLIDER CRANK 



^990 
^5000 
6010 
6020 
6030 
6040 
^050 
%060 
6070 
6080 
6090 
6100 
^110 
%120 
6130 
6140 
6150 
6160 
^170 
• l80 
6190 
6200 
6210 
6220 
^230 
%240 
6250 
6260 
6270 
6280 
6290 
•300 
6310 
6320 
6330 
6340 
6350 
•360 
6370 
6380 
6390 
6400 
6410 
•420 
6430 
6440 
6450 
6460 
6470 
•480 
6490 
6500 
6510 
6520 
6530 
•540 
6550 
6560 
hi) ) ) ) 

6570 


1-1 J COUNTER 

IF Rflag-1 THEN 
Delatep-1 
YO-Delatep 
ELSE 

YO-Delatep 
END IF 

Endpnt-Adiat * 12 
Theta2— l*Beta 
Iota2-Iota 
I 

1 BEGIN LOOP OVER ACCELERATION DISTANCE 

I 

FOR Y-YO TO Endpnt STEP Delstep 
Yl-Y/12 

T-ABS(SQR(2*Y1/Accel) ) 

V-Accel*T 

1 

1 DETERMINE JOINT ANGLES 

I 

Xnew-Newf oot ( 1 ) 

Ynew-Newf oot ( 2 ) 

Lac-SQR(Xnew A 2+(Ynew-(Yl) ) A 2) 

Pai-ATN ( (Ynew- (Yl) ) /Xnew) 

CALL Ss8(Flen,Tlen,Lac,A3) 

IF Psi<0. THEN A3— 1*A3 
Theta-Psi-A3 
IF Psi>0. THEN 
Gamma-PI/2-Psi 
ELSE 

Gamma-Psi+PI/ 2 
END IF 

CALL Sss(Lac,Flen,Tlen,A3) 

IF Gaauna>0. THEN 
Phi-Gamina-A3 
ELSE 

Phi-A3 -Gamma 
END IF 
1 

i NOW OUTPUT ANGLES FOR SIMULATION IF SIMFLAG-1 

1 

IF Simflag-1 THEN 

CALL Sss (Tien, Lac, Flen,Iotal) 

Theta 1-Theta 

Anglel-(Thetal-Theta2) *180/PI 
Angle2»(Iotal-Iota2)*180/PI 
Free-2 . 0 

OUTPUT § Paths im;T 
OUTPUT §Pathsim;Free 
OUTPUT §Pathsim;Anglel 
OUTPUT §Pathsim;Angle2 
Theta2-Thetal 
Iota2— lotal 
END IF 
! 

1 NOW CALCULATE THE PHYSICAL PARAMETERS 

! 

Fomega (I) -ABS ( (V*COS (Phi) )/ (Flen* (COS (Theta) *COS (Phi) -SIN (Theta) *SIN(P 
Toraega ( I ) =ABS ( (Fomega (I) *SIN (Theta) )/COS(Phi) ) 



Cnt-0 

! 


0 ICNT COUNTS THE NUMBER OF LINES PRINTED ON THE SCREEN SO THAT 
SCROLLING OF THE SCREEN CAN BE PREVENTED 
IF Actflag-2 THEN 


£580 Numbbc— l*Accel*Tlen*SIN (Theta) -Tomega(I) A 2*Tlen A 2* (COS (Phi) *SIN (Theta 

T*’SIN(Phi) *COS (Theta) )+Fomega (I) A 2*Flen A 2* (COS (Theta) A 2-SIN (Theta) A 2) 

6590 Talpha-Numbbc/ (-l*Tlen A 2* (COS(Phi)*COS(Theta)+SIN(Phi) *SIN (Theta) ) ) 

8600 Falpha- (Talpha*Tlen*COS (Phi) /2-Tomega (I) A 2*Tlen*SIN (Phi) +Fomega (I) A 2*F 

len*COS (Theta) ) / (Tlen*SIN (Theta) ) 

8610 Axtibia— l*Talpha*Tlen*COS(Phi)/2+Tomega(I) A 2*Tlen*SIN(Phi)/2 

6620 Aytibia— l*Accel-Talpha*SIN(Phi) *Tlen/2-Tomega(I) A 2*Tlen*COS(Phi)/2 

•530 Fbx-Mt ib ia * Axt ib ia 

6640 Fby«Wgt/3-Mtibia*Aytibia-Mtibia*G 

6650 Ftorque(I)-ABS(Ifemur*Falpha+Fbx*Flen*SIN(Theta)+Mfemur*G*Flen*COS(The 

ta)/2-Fby*Flen*COS (Theta) ) 

6660 Ttorque ( I ) -ABS ( -l*It ibia*Talpha-Mtibia*G*Tlen*SIN ( Phi) /2+Wgt*Tlen*SIN ( 

Ehi)/2) 

•570 Fhp ( I i -ABS ( Ftorque ( I ) *Fomega (I)/550) 

6680 Thp ( I ) -ABS ( Ttorque ( I ) *Tomega (I)/550) 

6690 1 

6700 ! IF ACTUATOR IS A LINEAR ONE, THEN CALCULATE THE MOMENT ARM 

6710 t IF IT IS A ROTARY ONE, THEN COMPARE TORQUE'S AND OMEGA'S NEEDED 

4 720 1 WITH THE ONES YOU CAN SUPPLY * 

>730 ! 

6740 Cnt-0 ICNT COUNTS THE NUMBER OF LINES PRINTED ON THE SCREEN SO THAT 
6750 ! SCROLLING OF THE SCREEN CAN BE PREVENTED 

6760 IF Actflag-2 THEN 

6770 1 

4 780 1 NOW, CALCULATE THE MOMENT ARM FOR THE LINEAR ACTUATOR 

>790 1 

6800 MAT Trans3- IDN 

6810 MAT Trans2- IDN 

6820 CALL Rot (Theta, Trans3 (*) ) 

6830 MAT Newfem- Trans3*Femur 

6840 MAT Newb- Trans3*B 

#850 MAT Newd- Trans3*D 

6860 MAT Temp 2- E-Femur 

6870 Temp2(4)-1 

6880 MAT Tempi- Trans3*Temp2 

6890 CALL Sss(Tlen,Lac,Flen,A3) 

6900 A3— A3 -PI/ 2 

#8l0 CALL Rot (A3 , Trans2 ( * ) ) 

6920 CALL Trans (Newfem (*) ,Trans2 (*) ) 

6930 MAT Newe- Trans 2 * Tempi 

6940 CALL Eqline(A(*) ,Newb(*) ,C(*) ,Farm) 

6950 CALL Eqline(Newd(*) ,Newe(*) , Newfem (*) ,Tarm) 

6960 A3— A3+PI/2 

•70 CALL Rot (A3 , Trans2 ( * ) ) 

6980 MAT Tempi- Trans3*Foot 

6990 MAT Newfoot2- Trans2*Templ 

7000 1 

7010 1 CAN GIVEN ACTUATOR SUPPLY POWER? 

7020 ! 

1D30 Test-ABS (Ftorque(I)/Farm) 

7040 Test2-ABS(Fomega(I) *Farm) 

7050 Testf-ABS (Ttorque (I)/Tarm) 

7060 Testv-ABS (Tomega ( I ) *Tarm) 

7070 IF Test>Aforce THEN 

7080 IF Rflag-1 THEN 

•90 PRINT CHR$ (129) 

7100 PRINT "FEMUR ACTUATOR IS NOT GOOD ENOUGH - FORCE NOT ENOUGH!!!" 

17110 PRINT CHR$ (128) 

7120 Minarm=Ftorque(I)/Aforce 

7130 PRINT USING " 2 9A, DDDDD. DD" ; "MINIMUM MOMENT ARM NEEDED IS ";Minarm*l 


J;" IN." 
^140 
IN." 

7150 
E TO 


PRINT USING "29A, DDD. DD" ; "PRESENTLY, HAVE MOMENT ARM - Farm* 12;" 

PRINT USING n 3 OA , DDDDDD . DD , 17 A , DDDDD . DD" ; "OR INCREASE ACTUATOR FORC 
";Test;" LBF. INSTEAD OF M ;Aforce;" LBF" 


7160 

PRINT 

^170 

Cnt-Cnt+7 

#180 

ELSE 

7190 

Femf flag-2 

7200 

END IF 

7210 

END IF 

7220 

IF T«st2>Avel THEN 

7230 

IF Rflag-1 THEN 

#240 

PRINT CHR$ (129) 

7250 

PRINT "FEMUR ACTUATOR IS 

7260 

PRINT CHR$ (128) 

7270 

Maxarm-Avel/Fomega ( I ) 

7280 

PRINT USING "49 A, DDD.DD" 

1 ATOR IS 

";Maxarm*12;" IN." 


#290 

IN." 

7300 


PRINT USING "33A, DDD. DD, 19A, DDD.DD" ;"0R INCREASE ACTUATOR VELOCITY 


TO ";Test2*12?" IN/SEC INSTEAD OF " ;Avel*12;" IN/SEC" 


7310 
7320 
#330 
7340 
7350 
7360 
7370 
7380 
#390 
7400 
7410 
7420 
7430 
7440 
#450 
7460 
7470 
7480 
7490 
7500 
# IN." 

7510 

IN." 

7520 

TO ";Testf;" 


PRINT 
Cnt-Cnt+7 
ELSE 

Femvf lag-2 
END IF 
END IF 

IF Cnt>9 THEN 

DISP "HIT ANY KEY TO CONTINUE"; 

ON KBD GOTO 7410 
GOTO 7400 
Cnt-0 

CLEAR SCREEN 
END IF 

IF Testf>Aforce THEN 
IF Rflag-1 THEN 
PRINT CHR$ (129) 

PRINT "TIBIA ACTUATOR IS NOT GOOD ENOUGH - FORCE NOT ENOUGH!!!" 
PRINT CHR$ (128) 

Minarm-Ttorque ( I ) /Af orce 

PRINT USING "29A, DDD.DD"; "MINIMUM MOMENT ARM NEEDED IS " ;Minarm*12 ; 


PRINT USING "29A, DDD.DD"; "PRESENTLY, HAVE MOMENT ARM - " ;Tarm*12 ;" 

PRINT USING " 3 OA, DDDDDD. DD,17A, DDD.DD"; "OR INCREASE ACTUATOR FORCE 
LBF. INSTEAD OF ";Aforce;" LBF" 


7530 

PRINT 

#540 

Cnt-Cnt+7 

7550 

ELSE 

7560 

Tibfflag-2 

7570 

END IF 

7580 

END IF 

7590 

IF Cnt>9 THEN 

#600 

DISP "HIT AN' 

7610 

ON KBD GOTO ‘ 

7620 

GOTO 7620 

7630 

Cnt=0 

7640 

CLEAR SCREEN 



650 END IP 

660 IF Taatv>Aval THEN 

670 IF Rflag-1 THEN 

680 PRINT CHR$ ( 129) 

S90 PRINT "TIBIA ACTUATOR IS NOT GOOD ENOUGH - VELOCITY NOT ENOUGH III" 

700 PRINT CHR$ (128) 

710 Maxarm-Aval/Toinega ( I ) 

y 2 o PRINT USING "49 A, DDD. DD" ; "MAXIMUM MOMENT ARM POSSIBLE FOR THIS ACTU 

POR IS ' MaX p^^ 2 u SI NG* " 29 A, DDD. DD" ; "PRESENTLY, HAVE MOMENT ARM - "?Tarm*12;" 

4 " 

;40 PRINT USING "33A,DDD.DD, 19A,DDD.DD";"0R INCREASE ACTUATOR VELOCITY 

3 ";Testv*12;" IN/SEC INSTEAD OF ";Avel*12?" IN/SEC" 


PRINT 
Cnt-Cnt+7 
ELSE 

Tibvflag»2 
END IF 
END IF 


! 

! 

1 

ELSE 


750 
760 
770 
780 
790 
300 
310 
320 
330 
340 
350 
360 
370 
380 
390 

300 

r-LBS , BUT ACTUATOR ONLY SUPPLIES ";Atorque 
310 PRINT 

320 Cnt-Cnt+5 

330 ELSE 

340 Femfflag-2 

350 END IF 

360 END IF 

370 IF Fomega(I)>Aomega THEN 

180 IF Rflag-1 THEN 

190 PRINT CHR$ (129) 

|00 PRINT "FEMUR ACTUATOR IS NOT GOOD ENOUGH - OMEGA NOT ENOUGH" 

HO PRINT CHR$ (128) 

,20 PRINT USING "14 A, DDD. DD, 36A, DDD. DD" J "NEED OMEGA OF " ;Fomega(I) ?" RA 


NOW, FOR A ROTARY ACTUATOR 

IF Ftorque(I)>Atorque THEN 
IF Rflag-1 THEN 
PRINT CHR$ (129) 

PRINT "FEMUR ACTUATOR IS NOT GOOD ENOUGH - TORQUE NOT ENOUGH" 

PRINT CHR$ ( 128) , „ , 

PRINT USING "15A, DDD.DD, 35A, DDD. DD" ;"NEED TORQUE OF " ; Ftorque ( I ) ; " 


'SEC, BUT ACTUATOR ONLY SUPPLIES "jAomega 


130 PRINT 

140 Cnt»Cnt+5 

150 ELSE 

160 Femtflag=2 

»70 END IF 

>80 END IF 

>90 IF Ttorque ( I ) >Atorque THEN 

.00 IF Rflag-1 THEN 

20 PRINT "TIBI^ACTUATOR IS NOT GOOD ENOUGH - TORQUE NOT ENOUGH" 

40 PRINT USING 1 " 15A, DDD. DD,35A, DDD.DD"; "NEED TORQUE OF ", -Ttorque (I) »■ 

W LBS , BUT ACTUATOR ONLY SUPPLIES ";Atorque 

50 PRINT 

60 Cnt-Cnt+5 

70 ELSE 

80 Tibf f lag=2 



TO CONTINUE"; 


THEN 


4 


END IF 
END IF 

IF Cnt>ll THEN 

DISP "HIT ANY KEY 
ON KBD GOTO 8250 
GOTO 8240 
Cnt-0 

CLEAR SCREEN 
END IF 

IF Iomega (I) >Aomega 
IF Rflag-1 THEN 
PRINT CHR$ (129) 

PRINT "TIBIA ACTUATOR IS NOT GOOD ENOUGH - OMEGA NOT ENOUGH" 

PRINT USING^"14A, DDD. DD, 36A, DDD. DD" ; "NEED OMEGA OF " ;Tomega (I) ; " RA 
D/SEC, BUT ACTUATOR ONLY SUPPLIES ";Aomega 
PRINT 
Cnt-Cnt+5 
ELSE 

Tibvflag«2 
END IF 


^190 
o200 
8210 
8220 
8230 
8240 
J250 
»260 
8270 
8280 
8290 
8300 
310 
320 


8330 


D/SEC, 

BUT 

8340 


8350 


JJ360 


•b370 


8380 


8390 


8400 

END 

8410 

l 

8420 

! 

%430 

1 

8440 


8450 



END 

IF 


IF 


LOOP BACK FOR ACCELERATION DISTANCE 


B 49 u CAIX f OutdatM Jdist , Adist , Ftorque ( * ) ,Ttorque(*) ,Fomega(*) ,Tomega(*) ,Fhp 

(*) ,Thp ( * ) , §Pathl , §Path2 , epath3 , 6Path4 , 6Path5 , §Path6 , Of lag (*) ,Y,Cnt,I) 


8460 

8470 

*3480 

8490 

8500 

8510 

8520 

8530 

€8540 

8550 

8560 

8570 

8580 

8590 

€8600 

8610 

8620 


END IF 
I-I+l 
NEXT Y 
1 
i 
1 

IF 


WRITE LINE TO END SIMULATION FILE 


Simf lag-1 THEN 
Endnum-999 . 0 
OUTPUT §Pathsim;Endnum 
OUTPUT §Pathsim;Free 
OUTPUT §Pathsim;Free 
OUTPUT 8 Paths in; Free 
END IF 

1 NOW CALCULATE THE STROKE LENGTH FOR THE ACTUATOR 

Fsl-ABS(SQR( (origb(l) -A(l) ) A 2+ (Origb(2) -A(2) ) A 2) -SQR( (Newb(l) -A(l) ) A 2+(New 

8g30~ A Tsi=ABS(SQR( (Origd(l) -Orige(l) ) *2+(Origd(2)-Orige(2) ) A 2)-SQR( (Newd(l)-Newe 
(1) ) A 2+(Newd(2) -Newd(2) ) A 2) ) 

I 

CLEAR SCREEN 

IF THE MAXIMUM VALUES WERE DESIRED, THEN THIS SECTION 
DETERMINES THE MAXIMUM TORQUE AND ANGULAR VELOCITY 


€8640 

8650 

8660 

8670 

8680 

8690 

fe700 

8710 

8720 

8730 

8740 


! 

! 

1 

IF 


Actflag-2 THEN 

PRINT USING "22A, DD. DD" ; "FEMUR STROKE LENGTH 
PRINT USING "22A,DD.DD"; "TIBIA STROKE LENGTH 
PRINT 
END IF 


" ;Fsl*12 ; " 
" ;Tsl*12 


IN." 

IN." 


A750 

8760 

NT I!" 

8770 

8780 

8790 


IF Femfflag-2 THEN 

PRINT "FEMUR ACTUATOR NOT GOOD ENOUGH II NEED MORE TORQUE ABOUT JOI 
END IF 

IF Femvflag-2 THEN 

PRINT "FEMUR ACTUATOR NOT GOOD ENOUGH l ! NEED MORE ANGULAR VELOCITY 



8810 
8820 
NT II" 
8830 

K 40 
50 

ABOUT 

8860 

8870 

8880 

K 90 
00 
8910 
8920 
8930 
8940 


JOINT 11" 

END IF 

IF Tibfflag-2 THEN 

PRINT "TIBIA ACTUATOR NOT GOOD ENOUGH 1 1 NEED MORE TORQUE ABOUT JOI 
END IF 

IF Tibvflag-2 THEN 

PRINT "TIBIA ACTUATOR NOT GOOD ENOUGH 1 1 NEED MORE ANGULAR VELOCITY 
JOINT I l " 

END IF 
PRINT 

MAT SEARCH Ftorque,MAX;Maxft 
MAT SEARCH Ttorque,MAX;Maxtt 
MAT SEARCH Fonega,MAX;Maxfo 
MAT SEARCH Tomega,MAX;Maxto 
MAT SEARCH Fhp,MAX;Maxfhp 
MAT SEARCH Thp,MAX;Maxthp 

PRINT USING " 35 A,DDDD.DD"; "MAXIMUM TORQUE ABOUT THE FEMUR WAS "?Maxft;" 



LBS" 


";Maxfo;" 


8960 


PRINT USING 
RAD/SEC" 
PRINT USING 


"4 5A,DD.DDD"; "MAXIMUM ANGULAR VELOCITY ABOUT THE FEMUR WAS 
"35A,DDDD.DD"; "MAXIMUM TORQUE ABOUT THE TIBIA WAS "jMaXtt;" 


FT- LBS" 

B970 PRINT USING " 4 5A, DD.DDD" ; "MAXIMUM ANGULAR VELOCITY ABOUT THE TIBIA WAS 

"iMaxto t" RAD/SEC" 

9^80 PRINT USING "42A,D. DDD" ; "MAXIMUM HORSE POWER ABOUT THE FEMUR WAS - ";Ma 

Xfhp?" HP" 

8990 PRINT USING " 42 A, D. DDD" ; "MAXIMUM HORSE POWER ABOUT THE TIBIA WAS - ";Ma 

Xthp?" HP" 

9000 DISP "HIT ANY KEY TO CONTINUE"; 

9010 ON KBD GOTO 9030 

Ib20 GOTO 9020 

9030 1 

9040 1 LOOP BACK TO THE MENU 

9050 I 

9060 GOTO Menu 
9070 I 

lb 80 | STOP PROGRAM 

9090 1 

9100 END 
9110 1 


>120 

9130 


KL40 SUB Pr intvar ( Jdist , Adist , Wgt , G , Mf emur , Flen , Mtibia , Tien , Angf , Angt , A ( * ) ,B(*) 
,C(*) ,D(*) ,E(*) , Beta, Iota, Aforce, Avel,Actflag,Actt,Acto) 

>150 I 

>160 I THIS SUBROUTINE SIMPLY PRINTS THE VARIABLES THAT THE USER CAN 
>170 1 CHNAGE TO THE SCREEN 

>180 1 

(.90 PRINT "HERE ARE THE PRESET PARAMETERS;" 

•200 PRINT " " 

•210 PRINT "INITAL ANGLE FEMUR AND HORIZONTAL » " ;Beta*180/PI ; "DEG" 

>220 PRINT "INITAL ANGLE FEMUR AND TIBIA - " ;Iota*180/PI ; "DEG" 

230 PRINT "JUMP DISTANCE - " ;Jdist*12;"IN." 



~S240 PRINT "ACCELERATION DISTANCE - ";Adiat*12;"IN." 

*9250 PRINT "WEIGHT OF SKITTER - ";Wgt;"LBF" 

9260 PRINT "FEMUR'S WEIGHT - " ;Mfemur*G;"LBF" 

9270 PRINT "FEMUR'S LENGTH - 

9280 PRINT "TIBIA'S WEIGHT - " ;Mtibia*G; "LBF 
9290 PRINT "TIBIA'S LENGTH - ";Tlen*12;"IN." 

*KlO IF ^PRINT^USING^ 37 A , DDD . DD , 2X , DDD . DD, 2X, DDD. DD" ; "POINT A COORDINATES ARE 

^20 INCHES ^INT A USING 2 "37a! DDd! DD^DDD. DD, 2X, DDD. DD" ; "POINT B COORDINATES ARE 
/ tn TNrtfFS\ * h *12 ,B(2) *12#B(3) *12 

9330 PRINT USING "37A, DDd! DD, 2X, DDD. DD, 2X, DDD. DD" ; "POINT C COORDINATES ARE 

/tv TMrHFS\ ' w # c ( *12 » C f 2 ) * 12 # C ( 3 ) *12 

^340 PRINT USING "37A, DDD. DD, 2X, DDD. DD, 2X,DDD.DD" ; "POINT D COORDINATES ARE 

fIN INCHES): ";D(1) *12,D(2) *12, D (3) *12 

9350 PRINT USING «37A,DDD.DD,2X,DDD.DD,2X,DDD.DD";"POINT E COORDINATES ARE 

(IN INCHES): ";E(1)*12,E(2)*12,E(3)*12 
9360 END IF 

^370 IF Actf lag-2 THEN . . _ ____ 

%380 PRINT USING "17A,DDDD.DD"; "ACTUATOR FORCE - ";Aforce;" LBF" 

^ PRINT USING "20A, DDD. DD"; "ACTUATOR VELOCITY - ";Avel*12;" IN/SEC" 

ELSE 

PRINT USING "18A,DDDD.DD"; "ACTUATOR TORQUE - ";Actt;" FT-LBS" 

PRINT USING "17A, DDD. DD"; "ACTUATOR OMEGA - "|Acto;" RAD/SEC" 


>370 
*380 
9390 
9400 
9410 
9420 
J430 
^440 
9450 
9460 
9470 
9480 
*>490 
%500 
9510 
9520 
9530 
9540 
9550 
•560 
9570 
9530 
9590 
9600 
9610 
*620 
9630 
9640 
9650 


END IF 

END SUBROUTINE 


I 
l 
1 

SUBEND 

1 

I 

SUB Invar (Mf emur , I femur, Flen , Mt ibia , It ibia , Tien) 

1 THIS SUBROUTINE DEFINES THE VARIABLES THAT NEED BE CALCULATED 
1 FROM OTHER INPUT VARIABLES 

Ifemur-.0252+Mfemur* (Flen/2) A 2 

Itibia-. 01495+Mtibia* (Tlen/2) *2 
I 

l END SUBROUTINE 
I 

SUBEND 

l 

I 

SUB Outdata ( Jdist , Adist , Ftorque ( * ) ,Ttorque(*) ,Fomega(*) ,Tomega(*) ,Fhp(*) ,T 


hp ( * ) » §Pathl , §Path2 , 6Path3 , §Path4 , $ Paths , §Path6 , Of lag ( * ) , Y , Cnt , I ) 


THIS SUBROUTINE OUTPUTS THE DATA 


9660 1 

• 670 1 

9680 1 

9690 Temp-0 
9700 FOR J-l TO 6 

9710 IF Oflag(J)-0 THEN Temp-1 

9720 NEXT J 
•730 IF Cnt>13 THEN 

9740 DISP "HIT ANY KEY TO CONTINUE"; 

9750 ON KBD GOTO 9770 

9760 GOTO 9760 

9770 Cnt-0 


140780 
'^790 
9800 
9810 
NCB W 
9820 
1^830 
1^840 
9850 
9860 
9870 
9880 
1^890 
1^900 
9910 
9920 
9930 
9940 
I J950 
1^960 
9970 
9980 
9990 
10000 
1^0010 
|®0020 
10030 
10040 
10050 
10060 
I J0070 
1*0080 
10090 
10100 
10110 
10120 
lO 130 
1*0140 
10150 
10160 
10170 
10180 
. 10190 
|%0200 
10210 
10220 
10230 
10240 
10250 
*0260 
10270 
10280 
10290 
10300 
10310 
*0320 
10330 
10340 
10350 
10360 


CLEAR SCREEN 
END IF 

IF Temp-1 THEN 

PRINT USING "DDD.D,32A";Y/(Adist*12)*100;" « 


THROUGH ACCELERATION DISTA 


PRINT 
PRINT 
Cnt-Cnt+3 
END IF 

IF Cnt>14 THEN 

DISP "HIT ANY KEY TO CONTINUE" ? 

ON KBD GOTO 9900 
GOTO 9890 
Cnt-0 

CLEAR SCREEN 
END IF 

IF Temp-1 THEN 

PRINT USING "16A, DDD.DD" ? "JUMP DISTANCE - "yJdist*12y" IN." 

PRINT USING "24A f DDD.DD"y "ACCELERATION DISTANCE - ";Adist*12y" IN" 
Cnt-Cnt+2 
END IF 

IF Oflag(l)«l THEN 

OUTPUT @Pathl ; Jdist*12 , Ftorque (I) 

ELSE 

IF Cnt>15 THEN 

DISP "HIT ANY KEY TO CONTINUE"; 

ON KBD GOTO 10050 
GOTO 10040 
Cnt-0 

CLEAR SCREEN 
END IF 

PRINT USING "15A,DDDDDD.DD"; "FEMUR TORQUE - "yFtorque(I) y" FT-LB" 
Cnt-Cnt+1 
END IF 

IF Oflag(2)-l THEN 

OUTPUT 8Path2;Jdist*12,Fomega(I) 

ELSE 

IF Cnt>15 THEN 

DISP "HIT ANY KEY TO CONTINUE"; 

ON KBD GOTO 10180 
GOTO 10170 
Cnt-0 

CLEAR SCREEN 
END IF 

PRINT USING "14A,DDDD.DD" ; "FEMUR OMEGA - " yFomega (I) ; " RAD/SEC" 
Cnt-Cnt+1 
END IF 

IF Oflag(3)-l THEN 

OUTPUT §Path3;Jdist*12 f Fhp(I) 

ELSE 

IF Cnt>15 THEN 

DISP "HIT ANY KEY TO CONTINUE"; 

ON KBD GOTO 10310 
GOTO 10300 
Cnt-0 

CLEAR SCREEN 
END IF 

PRINT USING "11A,DDDD.DD"; "FEMUR HP = ";Fhp(I);" HP" 

Cnt=Cnt+l 
END IF 


«0370 IP Oflag(4)-l THEN 

10380 OUTPUT ®Path4 ; Jdist*12 ,Ttorque (I) 

10390 ELSE 

10400 IP Cnt>15 THEN 

10410 DISP "HIT ANY KEY TO CONTINUE" ; 

10420 ON KBD GOTO 10440 

i 0430 GOTO 10430 

0440 Cnt-0 

10450 CLEAR SCREEN 

10460 END IP 

10470 PRINT USING "15A, DDDD.DDDD" ; "TIBIA TORQUE - ";Ttorque(I) ;" FT-LB" 
10480 Cnt-Cnt+1 

4 0490 END IP 
0500 IP Oflag(5)-l THEN 
10510 OUTPUT 8Path5; Jdist*12,Tomega(I) 

10520 ELSE 

10530 IF Cnt>15 THEN 

10540 DISP "HIT ANY KEY TO CONTINUE" ;- 

t 0550 ON KBD GOTO 10570 

0560 GOTO 10560 

10570 Cnt-0 

10580 CLEAR SCREEN 

10590 END IF 

10600 PRINT USING "14A, DDDD. DDDD" ; "TIBIA OMEGA - ";Tomega(I) ;" RAD/SEC" 

J 0610 Cnt-Cnt+1 

0620 END IF 

10630 IF Oflag(6)-l THEN 

10640 OUTPUT §Path6 ; Jdist*12 , Thp ( I ) 

10650 ELSE 

10660 IF Cnt>15 THEN 

i 0670 DISP "HIT ANY KEY TO CONTINUE"; 

0680 ON KBD GOTO 10700 

10690 GOTO 10690 

10700 Cnt-0 

10710 CLEAR SCREEN 

10720 END IF 

10730 PRINT USING "11A, DDDD. DDDD" ; "TIBIA HP - ";Thp(I);" HP" 

10740 Cnt-Cnt+1 

10750 END IF 


10760 1 

10770 IF Temp-1 THEN 

10780 DISP "HIT ANY KEY TO CONTINUE"; 

10790 ON KBD GOTO 10810 

L0800 GOTO 10800 

10810 CLEAR SCREEN 
10820 END IF 
10830 1 

10840 1 END SUBROUTINE 
10850 1 
10860 SUBEND 
10870 1 
10880 ! 

L0890 1 

L0900 SUB Rot (Angle, Mat r ix (*) ) 

10920 1 THIS SUBROUTINE FORMS THE TRANSFORMATION MATRIX FOR A ROTATION 
L0930 1 ABOUT THE Z-AXIS. THE MATRIX IS A 4x4. 

.0940 ! 

0950 OPTION BASE 1 
.0960 Matrix (1, l)=COS (Angle) 



9*70 

10990 

10990 

11000 

11010 

11020 

U030 

11040 

11050 

11060 

11070 

11080 

U.090 

moo 

11110 

11120 

11130 

11140 

U.150 

fll60 

11170 

11180 

11190 

11200 

U.210 

*220 

11230 

11240 

11250 

11260 

11270 

*280 

11290 

11300 

11310 

11320 

11330 

#340 

11350 

11360 

11370 

11380 

11390 

#400 

11410 

11420 

11430 

11440 

11450 

#460 

11470 

11480 

11490 

11500 

11510 

#520 

11530 

11540 

11550 

11560 


Matrix (2, 2) -COS (Angle) 

Matrix (1, 2)— 1*SIN( Angle) 

Matrix ( 2 , 1 ) -SIN (Angle) 

FOR 1-1 TO 4 
FOR TO A 

IF ABS (Matrix (I, J))<. 0000001 THEN Matrix(I, J)-0. 

NEXT J 
NEXT I 
I 

1 END SUBROUTINE 

I 

SUBEND 

! 

I 

1 

SUB Trans(Dist(*) ,Matrix(*) ) 

! THIS FORMS A TRANSLATION MATRIX- THAT OFFSETS A ROTATION MATRIX 

l 

OPTION BASE 1 
Matrix (1,4) -Diet ( 1) 

Matrix (2,4) -Diet ( 2 ) 

Matrix (3,4) -Diet ( 3 ) 

! 

! END SUBROUTINE 
1 

SUBEND 

SUB Findfoot (Beta, Iota, Femur (*) ,Foot(*) ,Newfoot(*) ,Newfem(*) ) 

1 THIS SUBROUTINE WILL FIND THE FOOT POSITION GIVEN THE ANGLES 

BETWEEN THE FEMUR & THE HORIZONTAL & THE ANGLE BETWEEN THE FEMUR 
AND THE TIBIA 


1 
1 
! 

! 

OPTION BASE 1 

DIM Transl(4,4) ,Trans2(4,4) ,Templ(4) 

MAT Transl- IDN 
MAT Trans2- IDN 
CALL Rot ( Beta , Trans 1 ( * ) ) 

MAT Newfem- Transl*Femur 
MAT Tempi- Transl* Foot 
CALL Rot ( Iota, Trans2 (*) ) 

CALL Trans (Newfem (*) ,Trans2 (*) ) 

MAT Newfoot- Trans2*Templ 
1 

1 END SUBROUTINE 
! 

SUBEND 

1 

1 

1 

SUB Sss (S1,S2 ,S3 , A3) 

1 THIS SUBROUTINE DETERMINES ANGLE 3 FOR A TRIANGLE WHERE YOU 
1 KNOW THE 3 SIDES 

P-(Sl+S2+S3)/2 
Temp=SQR(P* (P-S2)/ (S1*S3) ) 

IF ABS (Temp) >1.0 THEN 

PRINT "IMPOSSIBLE POSITION TO REACH!!! 

ELSE 



11570 A3-2*ACS(Temp) 

L1580 END IF 
11590 1 

11600 1 END SUBROUTINE 

11610 1 

.1620 SUBEND 

:1630 1 

.1640 I 

.1650 ! 

.1660 SUB Eqline(J (*),K(*),L(*) ,Marm) 

.1670 ! 

.1680 ! THIS SUBROUTINE DETERMINES THE MOMENT ARM 
.1690 1 

.1700 OPTION BASE 1 

.1710 DIM R(4) 

.1720 M-(J(2)-K(2))/(J(1)-K(1)) 

.1730 B1«J(2)-M*J(1) 

.1740 B2«L(2)+L(1)/M 

.1750 R( 1) ** (B2-B1) / (M+l/M) 

.1760 R(2)«M*R(1)+B1 

.1770 Marm=SQR((R(l)-L(l))*2+(R(2)-L(2)) A 2) 

.1780 ! 

.1790 1 END SUBROUTINE 
.1800 ! 

.1810 SUBEND 



REM 


THIS PROGRAM WILL DETERMINE THE TORQUE NEEDED TO LEAN 
SKITTER THROUGH A DESIRED NUMBER OF DEGREES 

THE NECESSERY TORQUE AND ANGULAR VELOCITY AT THE HIP 
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I PROGRAM WRITTEN BY: 

! BRICE MACLAREN 

! GARY MCMURRAY 

! 

ppH ********************************************************************* 

OPTION BASE 1 
RAD 

DIM A(9,10) ,B(9) ,X(9) 
l 

l THIS DATA DEFINES THE SYSTEM MATRIX THAT 

l MUST BE SOLVED IN THE DYNAMICS TO CALCULATE THE 

! INPUT TORQUE. 

DATA 0,0, -1,0, 1,0, 0,0, 0,0 
DATA 0,0, 0,-1, 0,1, 0,0, 0,0 
DATA 0,0, 1,-1, 0,0, 0,0, 0,0 
DATA -1,0, 1,0, 0,0, 0,0, 0,0 
DATA 0,-1, 0,1, 0,0, 0,0, 0,0 
DATA 1,-1, 0,0, 0,0, 0,0, 1.0 
DATA 1,0, 0,0, 0,0, 1,0, 0,0 
DATA 0,1, 0,0, 0,0, 0,1, 0,0 
DATA -1,-1, 0,0, 0,0, 0,0, 0,0 
N-9 
! 

1 USER PROPMTED FOR VARIABLES 

1 

DISP "INPUT ANGLE OF ROTATION IN DEGREES"; 

INPUT Rotangle 
Rotangle-Rotangle * PI/ 180 

DISP "INPUT ACCELERATION ANGLE IN DEGREES"; 

INPUT Aangle 
Aangle*Aangle*PI/180 
1 

1 DEFINE LINK LENGTHES OF 4 -BAR 

! 

R=SQR( ( (9. 1602+15. 194 )/12) *2+ (20/12) A 2) 

Rl=44 . 35 
R2=R*12 
R3=*20 
R4=20 

Tlen=20/12 

Flen=20/12 

L-Flen 

G=»32.2 

Mfemur=3/G 

Mtibia=2/G 

Wgt»100 

Mbody-85/G 

1 

! DEFINE INERTIA'S 

1 

CALL Invar (Mfernir, If emur, Flen,Mtibia, Itibia,Tlen,R,Mbody, Ibody) 


CALCULATE NECESSSERY ANGULAR VELOCITES AND ACCELERATION 


630 Phi“ASN (20/ (R*12) ) 

640 H«R*SIN(Rotangla+Phi+Aangle) -R*SIN (Phi+Aangla) 

650 Pina lomagaad— 1*SQR ( 2 *Wgt *H/Ibody ) 

^60 Alphaad“-l*Finalomegaad A 2/(2*Aangle) 

*70 Totaltiae-ABS (Finalomagaad/Alphaad) 

680 1 

690 1 DEFINE INITIAL ANGLES 

700 1 

710 Thata4-PI-ASN(20/(R*12)) 

^20 PRINT "INITIAL THETA4 ;Theta4* 180/PI 

*30 CALL Findthetas (R1 , R2 , R3 , R4 , Theta2 ,Theta3 ,Theta4 ) 

740 Initthata4«Theta4 
750 Initthata3-Theta3 
760 Initth«ta2-Theta2 

770 Finalangle-Theta4-Rotangle-Aangle 
^80 1 

^90 1 BEGIN LOOPING OVER THETA4 

800 1 

810 Deltatheta-Aangle/10 

820 FOR Temp-(Inittheta4-Deltatheta) TO (Inittheta4-Aangle) STEP -l*Deltatheta 
830 Thata4«Ten>p 

.840 1 

%50 1 UPDATE ANGLES 

860 1 

870 CALL Findthetas(Rl,R2,R3,R4,Theta2,Theta3,Theta4) 

880 I 

890 1 CALCULATE TIME 

-900 l 

•&10 T-SQR(ABS ( ( Temp-In ittheta4 ) *2/Alphaad) ) 

920 t 

930 I CALCULATE ANGULAR VELOCITIES 

940 ! 

950 Omegaad-«Alphaad*T 

960 Omegaab-R*Omegaad*SIN(Theta3-Thata4)/(L*SIN(Theta3-Theta2) ) 

%70 Omegabc- (Omegaad*R*SIN (Theta4 ) -L*Omegaab*SIN (Theta 2 ) )/ (L*SIN(Theta3) ) 

980 1 

990 1 CALCULATE ANGULAR ACCELERATIONS 

1000 1 

1010 Numl«R*Alphaad*SIN(Theta3-Theta4)-R*(Omegaad A 2) *COS (Theta4-Theta3)+L* ( 

Omegaab A 2 ) *COS (Theta2-Theta3) +L* (Omegabc A 2) 

#1020 Alphaab-Numl/ (L*SIN(Theta3-Theta2) ) 

1030 Num2«Alphaad*R*SIN (Theta4) +Omegaad A 2*R*COS (Theta4 ) -Omegabc A 2*L*COS (The 

ta3) -Alphaab*L*SIN (Theta2) -Omegaab A 2*L*COS (Theta2) 

1040 Alphabc«Num2/ (L*SIN (Theta3) ) 

1050 i 

1060 1 CALCULATE CENTER OF MASSES ACCELERATIONS 

#1070 ! 

1080 Accelbx=-l*Alphabc*L*SIN(Theta3) -Omegabc A 2*L*COS(Theta3) 

1090 Accelby-Alphabc*L*COS(Theta3)-Omegabc A 2*L*SIN(Theta3) 

1100 Accelax— l*Alphaad*R*SIN (Theta4) -Omegaad A 2*R*COS (Theta4) 

1110 Accelay«Alphaad*R*COS (Theta4 ) -Omegaad A 2*R*SIN (Theta4 ) 

1120 Acceltibx=Accelbx/2 

#1130 Acceltiby»Accelby/2 

1140 Accel f emx»Accelbx-Alphaab*L*SIN (Theta2 ) /2-Omegaab A 2 *L*C0S (Theta2 ) /2 

Accel ferny* Ac ce 1 by+ A1 pha ab * L* COS (Theta 2 ) /2~ Oinegaab A 2*L*SIN (Theta2 ) /2 
1160 Accelbodx=Accelax/2 

1170 Accelbody=Accelay/2 
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I 

NEXT Tenp 
I 

READ A(*) 

A ( 3 , 3 ) -L*ABS (SIN (Thata3 ) ) 

A(3,4)"-l*L*ABS(COS(Theta3) ) 

A ( 6 , 1 ) -L* ABS ( S IN ( Tha t a2 ) ) 

A(6,2)— l*L*AP3(COS(Theta2)) 

A(9 , 1) — 1*ABS (R*SIN (Thata4 ) ) 

A (9 , 2 ) — 1*ABS (R*COS (Thata4 ) ) 

B ( 1) -Mtibia*Accel t ibx 
B ( 2 ) -Mtibia*Accaltiby+Mtibia*G 

B ( 3 ) -Itibia*Alphabc+Mt ibia*G*Tlen*COS (ThetaS ) /2 

B ( 4 ) “Mfemur* Accel ffemx 

B(5) -Mf emur* Accel femy+Mfemur*G 

B(6)-Ifemur*Alphaab+Mfemur*G*Flen*COS(Theta2)/? 

B ( 7 ) -Mbody * Acce lbodx 

B ( 8 ) -Mbody * Accelbody+Mbody *G 

B ( 9 ) -Ibody * Al phaad-Mbody * R* COS (Theta4 ) /2 

I 

CALL Gaus«(N,A(*),B(*),X(*)) 

1 

Power-X(9) *Omegaab 
Hp* Power/550 
! 

I STOP PROGRAM 

I 

END 

I 

I 

SUB Gauss(N,A(*) ,B(*) ,X(*)) 

I 

| THIS SUBROUTINE PERFORMS GAUSSIAN ELIMINATION 

l 

OPTION BASE 1 

! FIRST, REPLACE THE LAST COLUMN OF THE A MATRIX WITH THE 

1 B MATRIX 

! 

FOR 1-1 TO N 
A(I,10)-B(I) 

NEXT I 
I 

FOR K«1 TO N-l 
Jj-K 

Big-ABS(A(K,K)) 

Temp2-K+1 
FOR I«Temp2 TO N 
Ab“ABS ( A ( I , K) ) 

IF Big-Ab<0 THEN 
Big=Ab 
Jj=I 
END IF 
NEXT I 

IF Jj-K<>0 THEN 
FOR J=K TO N+l 
Temp*A(Jj , J) 

A(Jj,J)-A(K,J) 

A(K,J)«Temp 
NEXT J 
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END IF 

FOR I •■Tamp 2 TO N 

Quot-A(I,K)/A(K,K) 

FOR J-Temp2 TO N+l 

A(I,J)-A(I,J)-Quot*A(K,J) 

NEXT J 
NEXT I 

FOR I-Temp2 TO N 
A(I,K)-0. 

NEXT I 
NEXT K 

X(N)-A(N,N+1)/A(N,N) 

FOR Nn-1 TO N-l 
Suml-0 
I-N-Nn 
Ipl-I+1 

FOR J-Ipl TO N 

Suml«Suml+A(I, J) *X(J) 

NEXT J 

X(I)-(A(I,N+l)-Sural)/A(I,I) 

NEXT Nn 
SUBEND 
1 
I 
1 

SUB Printmat (Array ( *) ) 

1 THIS SUBROUTINE PRINTS OUT THE INPUT MATRIX 

l 

OPTION BASE 1 

FOR Row-BASE (Array, 1) TO SIZE(Array,l)+BASE(Array,l)-l 

FOR Column-BASE(Array,2) TO SIZE(Array,2)+BACE(Array,2)-2 
PRINT USING W DDD. DD, XX, # H jArray (Row, Column) 

NEXT Column 
PRINT 
NEXT Row 
SUBEND 

1 

SUB Invar (Mf emur , I femur , Flen , Mtibia , I tibia , Tien , R , Mbody , Ibody ) 

I THIS SUBROUTINE DETERMINES THE INERTIA FOR THE VARIOUS MEMBERS 

I ABOUT THEIR AXES 

! 

I femur-. 0252+Mfemur* (Flen/2) A 2 
Itibia-. 01495+Mtibia* (Tlen/2) A 2 

i IBODY IS DETERMINED ASSUMING THE BODY OF SKITTER IS SPHERICAL 

1 AND THAT THE LEGS DO NOT CONTRIBUTE SIGNIFICANTLY TO THE INERTIA 

Ibody-2*Mbody* (9. 16/12) A 2/5+Mbody*( (15. 194/12) A 2+(20. 9817/12) A 2) 

! 

! RETURN TO PROGRAM 
! 

SUBEND 

! 

SUB Findthetas (R 1 ,R 2 ,R3 ,R4 ,Theta2,Theta3,Theta4) 

J THIS SUBROUTINE FINDS THE OTHER JOINT ANGLES GIVEN ONE ANGLE 


f S80 
390 
2400 
2410 
2420 
2430 
2440 
7450 
2460 
2470 
2480 
L2490 

te 

2520 

2530 

2540 


FOR A 4-BAR LINK 


L"SQR(R1 A 2+R2 A 2-2*R1*R2*C0S (PI-Theta4) ) 
B«ta-ACS( (R1 A 2+L A 2-R2 A 2)/(2*R1*L) ) 
Psi-ACS((R3 A 2+L A 2-R4 A 2)/(2*R3*L)) 

Lamda-ACS ( (R4 A 2+L A 2 -R3 A 2)/(2*R4*L) ) 

IF (PI-Th«ta4)>-0 AND (PI-Theta4)<-PI THEN 
Thata2— 1* (Psi-Beta) 

Theta3-PI- ( PI-Lamda-Beta ) 

ELSE , _ „ 

Theta2— 1* (Psi+Beta) 

Theta3«PI- (PI-Lamda+Beta) 

END IF 
I 

l RETURN TO PROGRAM 

I 

SUBEND 


\ 

I 



